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ABSTRACT 

System  identification  for  an  Autonomous  Underwater  Vehicle  model 
design  is  performed  using  Recursive  Least  Squares  to  provide  a  best  fit 
discretized  transfer  function  between  dive  plane  command  signals  and 
vehicle  response  data.  The  data  was  provided  by  constructing  a  radio 
controlled  vehicle  model  and  performing  vertical  plane  maneuvers  in  a 
water  tank.  The  analog  input  and  output  signals  were  digitized  and 
recorded.  The  vehicle  design,  sensor  calibration,  and  resulting  responses 
are  discussed.  Vertical  plane  equations  of  motion  were  derived  and 
theoretical  plant  models  formulated.  Also,  analog  controller  designs  were 
performed  based  on  the  theoretical  plant  models.  This  study  will  lead  to 
adaptive  model  controllers  for  the  future. 
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I.  INTRODUCTION 

The  main  goal  of  this  thesis  was  to  investigate  a  technique  for 
determining  the  discrete  transfer  function  relation  between  the  command 
signals  to  an  underwater  vehicle  and  the  response  of  the  vehicle  to  those 
command  signals.  With  this  transfer  function  some  insight  into  the  actual 
values  of  the  hydrodynamic  coefficients  of  the  governing  equations  of 
motion  may  be  gained.  A  strong  interest  exists  in  the  Navy  concerning  the  use 
of  an  Autonomous  Underwater  Vehicle  (AUV)  in  various  operations,  such  as 
ASW,  reconnaissance,  decoy  and  surveillance.  It  was  the  purpose  of  this 
work  to  build  and  test  a  model  of  a  vehicle  which  might  be  used  as  an  AUV. 
The  model  was  self  propelled  and  remotely  controlled  by  radio  transmission. 
This  allowed  realistic  output  data  for  known  inputs  to  control  surfaces.  The 
model  size  was  kept  small,  only  30  inches  in  length,  because  of  test  facility 
limitations.  Tests  were  conducted  in  the  vertical  plane  since  depth  is  easily 
monitored  by  pressure  cells  and  dive  maneuvers  could  be  relatively  well 
executed  and  monitored. 

Establishing  this  type  of  test  program  provides  a  means  of  developing  the 
knowledge  base  for  construction  of  test  vehicles  and  the  corresponding  test 
procedures  for  evaluating  a  particular  shape.  Using  available  software  to 
analyze  data  and  provide  the  correlations  between  input  and  output  signals 
provides  the  means  to  check  the  quality  of  the  system  model  simulation. 
Ultimately,  on-line  refinement  of  the  system  model,  based  on  real-time 
vehicle  performance  data,  allows  for  real-time  model  parameter 


identification  and  adaptive  control.  This  is  perceived  to  be  necessary  in 
future  AUV  control  design. 

It  has  been  established  that  robust  controllers  can  be  designed  for 
underwater  vehicles  for  dive  plane  trajectory  tracking.  This  requires  the 
generation  of  dynamic  models  of  vehicle  performance.  These  models  are 
difficult  to  derive  analytically,  and  usually  need  the  evaluation  of 
hydrodynamic  coefficients.  An  alternative  approach  uses  system 
identification  techniques  to  develop  vehicle  transfer  functions  from 
experimental  maneuvering  tests.  Any  AUV  control  system  will  ultimately 
incorporate  adaptive  parameter  identification,  so  this  research  project  was 
initiated  to  develop  suitable  techniques  and  algorithms  that  may  be  used  for 
that  purpose. 

A  vehicle  shape,  not  necessarily  representative  of  any  specific  vehicle, 
was  selected  as  the  basis  for  the  design  and  development  of  a  test  model. 
Refer  to  Figure  1 .  The  model  was  equipped  with  radio  control,  rate  gyro 
sensors,  a  pressure  cell  depth  sensor  and  a  pressure  cell  speed  sensor.  Two 
DC  motors  provided  propulsion  power  and  a  digital  data  acquisition  system 
was  configured  and  operated  in  performing  a  series  of  experimental  dive 
plane  dynamic  response  tests.  The  specific  objectives  of  this  work  are  given 
below. 
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A.  SPECIFIC  OBJECTIVES 
The  specific  objectives  were: 

1)  Select  a  reasonable  vehicle  design  which  has  potential  for  use  as  an 
AUV  and  that  also  has  available  operational  characteristics,  such  as  the 
hydrodynamic  coefficients  of  the  governing  equations  of  motion. 

2)  Design  and  build  a  test  model  based  on  the  full  size  vehicle's  shape. 

3)  As  part  of  the  overall  design  process,  investigate  the  available  sensory 
devices.  Equipment  such  as  gyros,  inertial  sensors  and  pressure  cells  would 
be  sclented  based  upon  size,  cost,  sensitivity  and  range. 

4)  Establish  a  testing  technique  to  provide  the  needed  response  data  and 
digitize  this  data  for  input  to  files  for  analysis. 

5)  Design  control  systems  which  can  be  implemented  easily  for  vehicle 
control  during  testing  operations. 

6)  Establish  a  system  model  and  perform  simulation  studies. 

7)  Utilize  available  software  to  perform  an  analysis  of  the  data  and 
provide  the  system  transfer  function  for  comparison  to  the  model  simulation. 

B.  DESIGN  APPROACH 

The  first  step  was  to  select  the  vehicle  shape.  The  design  drawings  for  the 
vehicle  were  made  and  construction  commenced.  Component  selection  was 
also  performed  at  the  outset  since  it  impacts  the  model  design.  While  the  test 
model  was  being  built,  the  preliminary  plant  simulation  studies  were 
performed  and  simple  controller  designs  established  which  could,  if  needed, 
be  readily  implemented.  These  controllers  were  designed  for  operation  on 
analog  computers  since  a  digital  computer  control  system  was  not  expected  to 


be  ready  in  time.  As  it  turned  out,  insufficient  time  was  available  to 
implement  the  analog  controllers  as  well.  When  vehicle  construction  was 
complete,  calibration  of  components,  such  as  gyros,  control  surfaces  and 
pressure  cells  was  performed.  Preliminary  test  run  output  data  as  well  as 
input  command  signal  data  was  recorded  on  stripcharts.  Implementation  of 
an  analog-to-digital  board  and  digital  computer  system  for  the  remaining 
bulk  of  the  test  runs  provided  the  necessary  data  banks  for  transfer  function 
analysis.  The  's'  domain  simulation  model  was  determined.  Two  models  were 
used.  A  simple  third  order  model  derived  from  the  pitch  equation  of  motion 
and  a  more  complicated  4th  order  model  derived  when  considering  both  the 
pitch  and  heave  vertical  plane  equations  of  motion.  These  transfer  functions 
were  then  multiplied  by  the  applicable  calibration  constants  and  the  equation 
coefficients  determined.  Equation  coefficients  consisted  of  linear 
combinations  of  hydrodynamic  coefficients  and  vehicle  speed.  A  zero  order 
hold  was  used  for  transformation  from  the  V  domain  to  the  'z'  domain.  The 
sampling  period  was  0.05  seconds.  Data  analysis  software,  MATRIXX,  was 
utilized  to  perform  transfer  function  analysis. 


n.  CLASSICAL  CONTROLLER  DESIGN 

A.  INTRODUCTION 

This  chapter  describes  classical  control  techniques  for  operation  of  a 
vehicle,  as  well  as  providing  the  necessary  model  for  data  analysis.  Classical 
control  techniques  should  provide  adequated  control  of  the  model;  however, 
it  is  noted  that  this  form  of  controller  may  not  provide  the  best  choice  for 
actual  AUV  control.  A  model  based  controller  or  some  form  of  adaptive 
control  technique  may  be  more  beneficial  from  the  viewpoint  of  maximizing 
performance  at  most  or  all  possible  vehicle  speeds  and  environmental 
conditions.  While  the  control  system  discussed  here  was  not  actually 
implemented  on  the  test  model  vehicle,  the  discussion  following  is  useful  as  it 
provides  a  framework  for  the  implementation  of  a  classical  controller  at  a 
later  date,  and  illustrates  the  necessary  design  trade-offs. 

The  controller  design  was  based  on  the  following  guidelines. 

(1)  Keep  the  system  simple  to  facilitate  its  construction. 

(2)  Based  upon  a  selected  reference  speed  of  1.0  ft/sec,  optimize  the 
controller  to  prevent  overshoot  of  the  vehicle  beyond  command  depth. 

(3)  Maintain  control  over  commanded  pitch  angle.  This  should 
prevent  loss  of  vehicle  control  when  a  large  input  commmand  signal  for 
depth  is  provided. 

While  dynamic  tests  were  performed  using  direct  control  of  the  model 
control  surfaces  and  motor  speeds,  it  will  ultimately  be  desired  to  test  the 
vehicle  by  providing  an  input  to  an  automatic  control  circuit.  The  control 
circuit  would  then  generate  a  radio  control  signal  to  maneuver  the  vehicle. 


This  takes  the  man  out  of  the  loop  and  allows  for  evaluation  of  vehicle 
maneuvering  characteristics  without  human  control  input.  Although  four 
independent  control  systems  were  designed;  speed,  depth,  course  and  roll,  the 
lack  of  time  and  availability  of  facilities  limited  this  research  primarily  to 
pitch  and  depth  response. 

B.   DEPTH  CONTROL 

The  basic  concept  drawing  is  shown  in  Figure  2  below. 

PITCHRATE 


Command  Depth 
El 


PLANT 

gyro 

Command  Pitch  Angle 


El  :  Depth  Error 

E2  :  Pitch  Angle  Error 

R    :  Command  Dive  Plane  Angle 


Figure  2       Depth  Controller  Block  Diagram 


In  this  system  rate  gyro  output  signal  was  integrated  to  provide  the  pitch 
angle.  This  angle  was  then  compared  to  a  command  pitch  angle.  The 
command  pitch  angle  was  generated  by  comparing  desired  depth  to  actual 
depth  as  measured  by  the  pressure  cell.  This  depth  error  was  then  multiplied 
by  a  proportional  gain  and  derivative  gain.  The  derivative  gain  would 
provide  the  needed  anticipatory  response  to  minimize  overshoot.  The 
command  pitch  angle  was  designed  to  put  the  vehicle  in  an  optimum  dive 


angle  for  a  particular  depth  change  requirement  or  error  signal.  The 
maximum  dive  angle  was  selected  as  45  degrees.  Command  pitch  angle  and 
actual  pitch  angle  are  compared  to  generate  a  pitch  angle  error.  This  error 
was  multiplied  by  a  proportional  gain  to  give  a  dive  plane  angle  order.  The 
maximum  dive  plane  angle  is  30  degrees.  The  forward  and  aft  dive  planes 
acted  together  during  this  testing  but  future  designs  might  consider 
maneuvering  characteristics  utilizing  only  forward  or  aft  dive  planes,  or 
unequal  coupling  between  the  dive  planes. 

In  order  to  design  and  build  the  control  system  without  knowing  actual 
system  characteristics,  a  simplified  model  of  the  plant  was  needed.  A  first 
order  model  approximation  was  made  for  the  vessel  motion  in  the  vertical 
plane.  Equation  (1)  shows  the  transfer  function  relation  between  dive  plane 
angle,  5,  and  pitch  rate,  6. 

Ky*5  =  (JyS  +  By)*e  (1) 

As  can  be  seen,  the  indirect  hydrodynamic  terms  have  been  neglected  as  well 

as  the  bouyancy  term  which  provides  a  resisting  moment  because  of  the  offset 

between  the  center  of  gravity  and  the  center  of  bouyancy  along  the  vertical 

centerline.  Based  on  the  model  vehicle  design  given  in  Chapter  3,  an  estimate 
of  Ky  was  calculated  by  estimating  the  forces  developed  by  the  fore  and  aft 

dive  planes  and  calculating  the  pitching  moment  that  results.  For  a  dive  plane 
angle  of  30  degrees  and  a  vessel  speed  of  1  ft/sec,  the  lifting  forces  were 
calculated.  The  total  forward  dive  plane  area,  A,  is  [9.50  *  sin(30)]  square 

inches. 

Fbow  =  pAV2sin(9eff) 
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With  0eff  =  15  degrees,  Fbow  =  0.017  lbf  and  Fstem  =  0.48  lbf.  The  forward 

moment  arm  was  taken  as  7.6  inches  and  the  aft  moment  arm  as  16.375 

inches.  This  gives  a  total  moment  of  about  0.9  in-lbf.  Assuming  linear 
response  for  dive  plane  moment  vs.  dive  plane  angle,  the  constant  Ky  is  0.14 

ft-lbf/rad.  Estimated  values  of  J  and  B  were  determined.  The  closed  loop 
transfer  function  Gq  could  then  be  formulated. 

G0  =  KpyKy/{JyS2  +  ByS  +  KpyKy} 

con2  =  Kpy  *  Ky/Jy  2£con  =  By/Jy 

Setting  £  =  1.0,  the  value  of  Kpy  was  determined  to  be  0.0107.  This  is  a  very 

small  value  of  gain.  The  natural  frequency  gives  an  estimate  of  the  period  of 
126  seconds.  However,  choosing  a  shorter  period,  say  five  seconds,  yields  a 
value  for  natural  frequency  of  1.2566,  and  a  value  of  6.8  for  Kpy.  Kpy 
relates  pitch  angle  error  to  dive  plane  angle  and  must  be  selected  based  upon 
physical  limitations  of  the  plant.  With  Kpy  set  equal  to  0.7,  which  means  a 
pitch  angle  error  of  43  degrees  calls  for  a  dive  plane  angle  of  30  degrees,  the 
resulting  value  of  circular  natural  frequency  is  0.4  rad/sec  and  the  period  is 
15.5  seconds.  To  change  the  natural  frequency  and  hence,  the  period,  the 
control  variable  Ky  must  be  changed.  This  would  require  vehicle 
reconfiguration. 

The  value  of  damping  coefficient  estimated  by  linearizing  about  an 
angular  rate  of  1.0  rad/sec  was  0.836  ft-lbf/rad.  Since  a  larger  value  of 
damping  means  rate  feedback  may  not  be  necessary,  the  control  system 
design  will  assume  that  only  a  small  amount  of  damping  exists.  A  maximum 
limit  on  the  magnitude  of  the  rate  feedback  gain  can  then  be  set.  When  actual 
vehicle  damping  is  determined  the  rate  feedback  gain  can  be  adjusted 


accordingly.  Utilizing  rate  feedback  (Kr)  around  the  plant,  as  shown  in 
Figure  3,  the  transfer  function  now  becomes: 

Ge  =  KpyKy/{J  S2  +(B  +  KrKy)S  +KpyKy}  . 
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Figure  3       First  Order  Plant  Model 
For  a  damping  ratio  of  0.8,  The  value  of  Kr  is  found  to  be  2.31.  Kr  was  set 

equal  to  2.0.  This  gave  an  effective  damping  coefficient,  Beff,  of  0.34  and  a 
damping  ratio  of  0.708.  The  rate  of  change  of  depth  is  approximated  as  U*0. 

Depth,  z,  can  then  be  found  by  integration.  The  depth  control  system  is 
shown  in  Figure  4. 
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The  effective  damping  coefficient,  Beff ,  is  given  by:  By  +  Kr*Ky  . 
The  closed  loop  transfer  function  is: 

[KpzKyKpyU  +  (KdzKyKpyU)s] 
Gz  = 

[Js3  +Beffs2  +(KpyKy  +KdzKyKpyU)s  +KpzKyKpyU] 

The  steady-state  error  to  a  step  input  is  zero.  In  order  to  meet  the  necessary 
conditions  for  stability  the  following  requirements  must  be  met,  Kdz  >  -1/U 

and  Kpz  >  0.  For  Kdz  =  0.0,  Routh's  Stability  Criterion  shows  that  Kpz  < 

2/U. 

In  order  to  gain  an  understanding  of  how  stability  would  be  affected  by 
values  of  Kpz  and  Kdz,  Root  Locus  plots,  Figures  5  to  8,  were  made  for  two 

forward  speeds  and  two  values  of  proportional  gain.  The  derivative  gain, 
Kdz,  was  allowed  to  vary.  These  plots  showed  that  increasing  speed,  U,  or 

Kpz  resulted  in  moving  the  poles  closer  to  the  imaginary  axis.  This  indicates 

a  reduction  in  system  damping.  A  reasonable  value  of  Kpz  had  to  be  chosen. 

This  gain  provides  the  proportional  gain  between  the  depth  error  and  a 

command  pitch  angle.  For  a  three  foot  depth  change  corresponding  to  a  45 
degree  pitch  angle,  a  value  of  0.26  for  Kpz  results.  Kpz  was  set  equal  to  0.25. 

Root  locus  plots  corresponding  to  this  value  of  proportional  gain  are  shown 

in  Figures  9  to  10.  A  derivaitive  gain  of  about  0.5  for  a  forward  speed  of  1 .0 

ft/sec  indicates  a  damping  ratio  of  about  0.4  .  The  system  is  more  complicated 

than  a  simple  second  order  system  because  of  the  addition  of  the  zero  in  the 
numerator.  The  position  of  the  zero  is  determined  by  the  ratio  of  Kpz  to  Kdz. 
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Figure  5       RLP[Kpz=l  ,U=0.5,Kdz  Varied  0.0  to  100.0] 
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Figure  6       RLF[Kpz=l,U=l,Kdz  Varied  0.0  to  100.0] 
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Figure  7       RLP[Kpz=0.5,U=0.5,Kdz  Varied  0.0  to  100.0] 
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Figure  8       RLP[Kpz=0.5,U=l,Kdz  Varied  0.0  to  100.0] 
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Figure  9       RLP[Kpz=0.25,U=l,Kdz  Varied  0.0  to  100.0] 
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Figure  10     RLP[Kpz=0.25 ,Kdz=0.5,U  Varied  0.0  to  20.0] 
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To  get  a  better  insight  into  the  system  response,  the  time  responses  were 
plotted  for  various  values  of  derivative  gain  and  forward  speed.  Figures  1 1 
and  12  show  that  a  larger  derivative  gain  improves  the  response  by  reducing 
settling  time,  although  overshoot  increases.  Without  derivative  gain  the 
system  model  is  unstable  at  speeds  approaching  three  ft/sec  as  shown  in 
Figure  13.  Greater  system  damping  is  accomplished  by  adjustment  of  the  rate 
feedback  gain.  Analysis  of  the  vehicle  equations  of  motion  which  follows 
later  in  this  chapter,  indicated  that  damping  might  actually  be  on  the  order  of 
two  times  larger.  A  value  of  the  effective  damping  coefficient  was  increased 
from  0.34  to  0.72.  This  corresponds  to  a  value  of  rate  feedback  of  about 
4.71.  A  value  of  1.50  for  the  damping  ratio  coefficient  results.  The  root 
locus  plot  for  the  resulting  transfer  function  is  shown  in  Figure  14.  Note  the 
significant  change  in  the  character  of  the  root  locus.  With  the  increase  in 
system  damping  it  is  now  possible  to  select  a  value  of  derivative  gain  which 
will  provide  a  system  damping  ratio  between  0.5  and  1 .0.  For  a  speed  of  one 
ft/sec,  the  derivative  gain  for  zero  overshoot  is  =1.5.  At  a  higher  speed  of 

three  ft/sec,  this  value  of  derivative  gain  allows  some  overshoot.  Figures  15 
and  16  show  the  expected  time  responses  to  a  step  input  of  three  feet  in  depth. 

As  expected,  in  classical  control  techniques  the  values  of  gain  must  change  as 
the  plant  conditions  change  if  optimum  vehicle  performance  is  to  be  maintained. 
This  demonstrates  the  frequent  need  for  adaptive  control  techniques  or  model 
based  controller  designs.  For  the  purpose  of  model  testing  the  classical 
controller  is  sufficient.  A  suitable  set  of  gain  values  can  be  selected  for  the 
vehicle  test  speed.  For  completeness,  the  system  root  locus  plot  for  zero 
derivative  gain  was  considered.  The  simplest  control  system  would  consist  only 
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of  a  proportional  gain.  Figure  17  shows  that  at  high  speeds,  as  expected,  the 
system  becomes  unstable.  A  lower  value  of  proportional  gain  gives  a  greater 
range  of  stability.  Figure  18  shows  the  basic  depth  controller  block  diagram 
along  with  the  corresponding  analog  controller. 

C.   ROLL  CONTROL 

This  section  describes  the  method  of  approach  for  the  design  of  the  roll 
control  system.  Figure  19  shows  the  basic  block  diagram  of  the  roll  control 
system  along  with  the  analog  equivalent.  The  output  of  the  roll  gyro  is 
integrated  for  comparison  to  a  command  signal.  The  command  signal  would 
in  most  cases  be  equal  to  zero  reference  which  is  the  horizontal  plane.  The 
error  signal  is  then  multiplied  by  a  proportional  and  derivative  gain.  The 
derivative  gain  gives  the  desired  anticipatory  dyanamic  response.  The  output 
signal  is  the  forward  dive  planes  differential  angle  order.  The  dive  plane 
response  may  be  considered  as  analogous  to  the  ailerons  of  an  airplane.  Rate 
feedback  could  also  be  used  to  provide  a  satisfactory  system  response.  The 
system  model  was  approximated  by  a  first  order  system.  Equation  (2)  shows 
the  transfer  function  relation  between  forward  dive  plane  angle,  p,  and  roll 

rate,  6. 

Kx*p  =  (JxS  +  Bx)*6  (2) 
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Figure  13     RLP[Kpz=0.25  JCdz=0,U  Varied  0.0  to  10.0] 
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Figure  14     RLP[Kpz=0.25,U=L0,Kdz  Varied  0.0  to  100.03=0.72] 
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Figure  17     RLP[Kpz=0.25,Kdz=0.0,U  Varied  0.0  to  10.0,B=0.72] 
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An  estimate  of  Kx  was  made  by  assuming  a  linear  relation  between  the  dive 

plane  angle  and  the  roll  moment.  Assuming  a  forward  dive  plane  total  area  of 
four  in2,  the  force  produced  by  a  30  degree  dive  angle  while  traveling  at  one 
ft/sec  is  approximated  as:  F  =  pAV2sin(0/2) .  This  gives  a  value  of  0.014  lbf. 
With  a  moment  arm  of  about  nine  inches,  the  moment  produced  is  =  0.0105 
ft-lbf.  Assumimg  torque  is  equal  to  a  constant,  Kx  ,  times  the  angle  (3,  Kx  is 

determined  to  be  0.02  ft-lbf/rad.  With  the  plant  now  determined,  the 

controller  gains  could  be  selected.  The  closed  loop  transfer  function 

becomes: 

G0  =  [KxKpx  +  KxKdxS]  /  [JXS2  +  (B  +  KxKdx)S  +  KxKpx] 

A  reasonable  value  of  Kpx  was  selected.  For  a  one  degree  roll  error,  a  ten 
degree  plane  angle  was  chosen.  Thus,  Kpx  =10.  Kdx  could  then  be  solved  for 
as  follows.  cl^  =  sqrt  ( KxKpx/Jx } 

C  =  Beff/(2sqrt{KxKpxJx}) 

For  a  damping  ratio,  £  ,  of  0.9,  Beff  was  found  to  be  0.16.  As  a  result,  Kdx  is 
found  to  be  =  8.  Kdx  was  set  equal  to  10.0.  This  gives  an  effective  damping 

value  of  0.201  and  a  damping  ratio  of  1.12.  The  natural  circular  frequency  is 

5.0  rad/sec.  Utilizing  a  2%  settling  time  criterion,  the  settling  time  is  about 
0.7  seconds.  When  the  restoring  moment  is  added  to  the  plant  model,  Beff 

becomes  0.2,  Kdx  equals  10.0,  the  natural  frequency  is  2.739  rad/sec,  and  the 
resulting  settling  time  is  1.6  seconds.  A  root  locus  plot  is  shown  in  Figure  20. 
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Figure  20     RLP  RoU[Kpx=10.0,Me=0.1,Kdx  Varied  0.0  to  20.0] 
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D.   COURSE  CONTROL  SYSTEM 

The  course  control  system  is  similar  to  the  roll  control  system.  See 
Figure  19.  The  output  of  the  rudder  gyro  is  integrated  to  give  course  relative 
to  an  initial  reference  axis.  The  signal  is  compared  to  the  command  course 
signal  and  the  error  then  provides  the  input  to  a  proportional  plus  derivative 
controller  just  as  in  the  roll  control  circuit. 

The  plant  is  again  approximated  as  a  fust  order  system  and  is  given  by 
the  following  transfer  function  relating  i adder  angle,  5r,  to  yaw  rate,  \j/ . 

Kzx8r  =  (JzS  +  Bz)  *  \jr  (3) 

The  rudder  area  is  about  the  same  as  the  aft  dive  plane  area  but  the  amount  of 

rudder  which  is  within  the  propellor  propwash  is  less.  The  rudder  force  was 

only  roughly  estimated  at  about  0.03  lbf.  The  moment  arm  was  estimated  at 

14  inches.  Assuming  a  linear  relation  between  rudder  angle  and  force,  a 
value  of  Kz  was  calculated  to  be  about  0.07  ft-lbf/rad.  Now,  as  before,  the 

control  system  gains  can  be  determined.  The  closed  loop  transfer  function  is 

given  by: 

G(p  =  [KzKpy  +KzKdyS]  /  [JZS2  +(BZ  +  KzKdy)S  +KzKpy] 

A  gain  value  of  one  was  selected  for  Kpy.  Thus,  for  a  one  degree  course 

error,  a  one  degree  rudder  order  would  be  generated.  A  higher  gain  would 

probably  be  desirable  at  lower  speeds.  For  the  purpose  of  estimating 

controller  gains,  a  value  of  one  was  used.  Using  the  same  methods  as  before 
with  a  damping  ratio  of  0.9  arbitrarily  selected,  Kdy  was  found  to  be  3.3. 

Kdy  was  set  at  3.0.  This  gives  a  value  of  damping  of  0.828  and  a  2%  settlim 
time  of  10.0  seconds.  A  root  locus  plot  is  shown  in  Figure  21. 
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Figure  21      RLP  Yaw[Kpy=1.0,Kdy  Varied  0.0  to  20.0] 
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E.  SPEED  CONTROL 

A  speed  regulator  control  system  was  designed  to  maintain  a  desired 
command  speed.  Figure  22  shows  the  basic  block  diagram.  Command  speed 
is  compared  to  actual  speed  and  an  output  error  generated  which  is  then 
amplified  by  a  proportional  gain.  The  amplified  error  signal  is  then  summed 
with  the  command  speed  to  produce  the  control  input  signal  to  the  electronic 
speed  control  box.  The  electronic  speed  control  was  purchased  from  Vantec 
Inc.  which  specializes  in  speed  controls  for  radio  controlled  models.  It  is 
fully  proportional  and  designed  to  operate  on  12  VDC  input.  Based  upon  the 
input  signal  voltage,  the  voltage  applied  to  the  drive  motors  is  proportionally 
adjusted. 

F.  EQUATIONS  OF  MOTION 

The  following  section  concerns  the  theoretical  calculations  of  the 
hydrodynamic  coefficients  for  the  vertical  plane  equations  of  motion  for  the 
model  vehicle.  Also,  a  comparison  will  be  made  between  results  of  this 
simulation  and  the  simplified  model  controller  simulation  previously 
conducted.  The  effects  of  discarding  certain  hydrodynamic  derivatives  from 
the  simulation  will  be  looked  at.  The  equations  of  motion  are  given  below. 
The  prime  superscript  indicates  nondimensional  values. 

-Z'WW  +  (m'-Z'W)w'  -  (Z'q+nOq'  -  Z'qO/  =  Z'55 

-M*WW  -  M'^w  -  M'qq'  +  (ry-M'q)o/  -  M'0e  =  M'5S 
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The  hydrodynamic  derivatives  in  the  vertical  plane  were  estimated  using 
the  techniques  described  in  Reference  8,  Principles  of  Naval  Architecture. 
The  reference  quantities  used  are  given  in  Table  2  later  in  this  section.  The 
principle  model  dimensions  are  shown  in  Figure  23.  Once  the  equations  of 
motion  were  known,  a  Dynamic  Simulation  Language  (DSL)  program  was 
written  to  provide  a  simulation  of  a  depth  maneuver  for  a  given  step  change 
on  the  dive  control  planes.  Several  modifications  to  the  general  program 
were  made.  Various  hydrodynamic  coefficients  were  set  equal  to  zero  or 
adjusted  in  value  in  order  to  assess  their  importance.  The  principle  program, 
T2,  and  the  modified  programs  are  shown  in  Appendix  A. 

A  step  change  of +30  degrees  at  t=0+  was  input  forlO  seconds  and  then 
removed.  The  first  maneuver  was  carried  out  using  both  the  heave  equation 
and  the  pitch  equation  with  all  nonnegligable  derivatives  included.  The 
program  was  then  modified  by  removing  the  heave  degree  of  freedom  from 
the  simulation.  This  left  only  the  rotary  inertia,  damping  and  restoring 
moment  hydrodynamic  derivatives  in  the  pitch  equation.  This  is  program  T3 
in  Appendix  A.  Program  T4  provides  a  simulation  when  only  the  rotary 
inertia  and  damping  coefficients  exist.  The  simplified  control  system  analysis 
performed  in  the  previous  section  assumes  this  type  of  plant.  Program  T5  is  a 
simulation  with  both  equations  and  all  nonnegligable  derivatives  acting,  but 
the  rotary  damping  term  is  reduced  by  a  factor  of  ten.  The  DSL  simulation 
figures  are  located  in  Appendix  B. 
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PRINCIPLE   DIMENSIONS 


MODEL:      WEIGHT,       W«    19.6  lbs 


MASS,  M 

LENGTH,  L 

BREADTH,  B 

HEIGHT,  T 

RESTORING  ARM,  BG 

DISPLACED  VOLUME, 


0.609  slugs 
30  inches 
7.0  inches 
3.5  inches 
0.1  inch 

543  in3 


DIVE  PLANES: 


FWD 
MOMENT  ARM, 

MEAN  CHORD, 
MEAN  SPAN, 

AREA  (EACH), 
GEOMETRIC  ASPECT  RATIO, 

EFFECTIVE   ASPECT  RATIO, 

AFT 

MOMENT  ARM, 

MEAN  CHORD, 

MEAN   SPAN, 

AREA  (EACH), 

GEOMETRIC  ASPECT  RATIO, 

EFFECTIVE  ASPECT  RATIO, 


rl  " 

c  » 

b  « 

A  = 

o  ■ 
9 

a  = 


c 

b 
A 

3g 

a 


7.6  inches 

1.9  inches 

2.5  inches 

4.75  in2 
1.316 

2.63 


16.375  inches 
1.6  inches 
2.0  inches  - 
3.2  inches 
1.25 

2.5 


Figure  23     Principle  Dimensions 
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1.     Program  T2  (All  Derivatives) 

Figures  Bl  through  B3  show  that  the  vehicle  is  directionaily  stable 
and  is  well  damped.  The  step  input  in  control  planes  produces  a  large  initial 
angular  acceleration  with  a  corresponding  rapid  rise  in  linear  and  angular 
velocities.  This  results  in  a  fairly  rapid  change  in  depth  and  angular  position. 
Depth  changes  one  foot  in  four  seconds.  The  final  depth  reached  is  2.61  feet. 
The  oscillations  apparent  in  angular  position  as  well  as  linear  and  angular 
accelerations  is  a  result  of  the  restoring  moment.  This  moment  results  from 
the  offset  along  the  vertical  axis  of  the  center  of  gravity  from  the  center  of 
bouyancy.  Any  angular  inflections  resulting  from  control  plane  action  or 
distubances  are  resisted  by  this  moment.  Thus,  when  the  control  planes  are 
restored  to  zero  angle  of  attack,  the  vessel  reacts  to  the  restoring  moment  and 
returns  to  a  level  condition  with  respect  to  the  horizontal.  At  low  speeds  this 
restoring  moment  is  significant.  If  large,  a  considerable  dive  p^e  angle  will 
be  necessary  to  counter  this  moment  and  the  pitch  angle  reached  will  be 
considerably  less  than  if  this  moment  were  reduced.  The  moment  is  always 
there  but  at  higher  speeds  it  is  less  dominant  in  relation  to  the  other 
hydrodynamic  derivatives.  These  derivatives  have  a  dependency  on  speed, 
while  the  restoring  moment  is  a  static  effect.  The  nondimensionalized 
restoring  moment  coefficient  becomes  smaller  as  velocity  increases  because 
it  is  nondimensionalized  with  respect  to  velocity  squared  in  the  denominator. 
Steady-state  conditions  are  reached  in  about  four  seconds  from  the  step  input 
in  control  plane  movement. 


38 


2.  Program  T3 

Figures  B4  and  B5  show  the  results  of  a  maneuver  when  only  the 
pitch  equation  is  considered.  The  heave  equation  is  neglected.  Figure  B5 
shows  that  the  angular  velocities  and  accelerations  seem  not  to  be  affected. 
The  same  response  patterns  occur  as  previously.  The  pitch  angle  achieved  is 
slightly  greater  than  that  reached  before.  When  the  heave  equation  was 
considered  a  pitch  angle  of  about  -4.2  degrees  was  reached  as  was  shown  in 
Figure  Bl.  Without  the  heave  equation  a  pitch  angle  of  about  -4.4  degrees 
was  reached  as  shown  in  Figure  B4.  This  is  because  of  the  absence  of  the 
M'ww'  term  in  the  pitch  equation.  M'w  is  the  derivative  providing  the 
moment  which  results  as  a  consequence  of  linear  velocity.  The  sign  of  this 
coefficient  is  positive  while  the  sign  of  the  restoring  moment  term  is 

negative.  This  means  these  terms  are  working  against  each  other;  although 
M'w  is  small  in  relation  to  M'0.  Thus,  M'w  could  be  adjusted  by  design  of 

control  planes  and  hull  structure  to  partially  offset  M'0  .  The  final  depth 

achieved  is  about  1.77  feet.  This  demonstrates  a  32%  reduction  in  depth  for 
the  same  dive  plane  movement.  Figure  B2  shows  clearly  that  the  linear 
velocity,  w,  is  of  significant  proportion.  This  velocity  is  represented  in  the 
equation  for  rate  of  depth  change,  ZDOT,  by  the  term  wg  *  cos(alpha).  Refer 
to  computer  programs  of  Appendix  A.  This  linear  velocity  is  a  positive 
value;  therefore,  it  adds  to  the  velocity  component  which  results  from  the 
forward  velocity  and  the  pitch  angle. 

3.  Program  T4 

In  this  case  the  dive  planes  were  held  at  +30  degrees  for  only  one 
second.  This  was  necessary  to  prevent  the  vessel  from  performing  a  loop 
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maneuver.  With  the  restoring  moment  term  removed,  a  steady  state  pitch 
angle  cannot  be  attained  as  long  as  the  control  planes  are  at  an  angle  of  attack. 
This  situation  could  be  compared  to  a  vehicle  which  has  its  center  of  gravity 
coincident  with  its  center  of  bouyancy.  With  reference  to  Figure  B6, 
although  the  dive  planes  are  held  at  30  degrees  for  only  one  second,  a  -27.5 
degree  dive  angle  is  achieved.  This  shows  that  once  the  control  plane  angle  is 
removed  the  vessel  will  stabilize  as  a  result  of  damping  to  a  steady  pitch  angle 
and  continue  to  decrease  in  depth.  This  shows  straight  line  stability  but  no 
directional  stability  as  expected.  Comparing  the  angular  velocity  and 
acceleration  in  Figure  B7  to  those  reached  in  the  case  presented  in  Figure  B3 
indicates  an  increase  in  magnitude  of  at  least  a  factor  of  two.  This 
demonstrates  the  significance  of  the  restoring  moment.  A  vehicle  whose 
design  requirements  might  include  stationkeeping  (hovering)  while 
maintaining  other  than  a  horizontal  position  may  require  this  type  of 
character  to  minimize  power  consumption.  Careful  control  over  position  of 
the  center  of  gravity  in  relation  to  center  of  bouyancy  is  needed  to  ensure 
adequate  vehicle  controllability. 
4.     Program  T5 

In  this  program  all  hydrodynamic  coefficients  were  restored  but  the 
value  of  damping  was  reduced  by  a  factor  of  ten.  A  small  value  of  damping 
had  been  assumed  in  the  initial  controller  design.  Figures  B8  through  BIO 
show  the  results.  The  same  steady  state  depth  is  reached  as  expected.  With  the 
reduced  damping,  significant  oscillations  in  pitch  angle,  0,  and  in  all 

velocities  and  accelerations  are  evident.  The  oscillations  in  depth  will  mean 
wasted  power  in  a  real  vehicle  and  may  hamper  its  operations  as  well.  If 


40 


damping  was  a  problem,  an  adequate  control  system  must  be  designed  to 
compensate  for  this  by  using  techniques  such  as  rate  feedback  and  derivative 
control. 

5.     Calculation  of  Hydrodynamic  Derivatives 

Horizontal  plane  equations  of  motion  were  used  as  the  source  of  the 
vertical  plane  equations  used  here.  The  direction  of  positive  pitch  angle,  0,  is 
opposite  in  sense  to  positive  yaw  angle,  4/,  with  respect  to  the  'z'  and  'y'  axes 
respectively.  This  requires  sign  changes  in  the  indirect  hydrodynamic 

coefficient  equations.  Table  1  is  a  listing  of  the  coefficients.  The  indirect 
derivatives,  Z 'a  and  M'^,  are  generally  quite  small  for  most  bodies.  They 

have  been  assumed  to  be  zero. 

TABLE  1.    HYDRODYNAMIC  COEFFICIENTS 


Normalized 

Nondim 

Dimensional 

Coefficient 

Value 

Value 

Z' 

*-  w 

-1.295 

-0.8541  lbf-sec/ft 

7'  • 

^  w 

-0.65 

-1.001bf-sec2/ft 

7' 

-0.20 

-0.3078  lbf-sec 

71; 

^q 

0.0 

0.0 

Z'5 

+0.095 

+0.0627  lbf 

M'w 

+0.088 

+0.1354  lbf-sec 

M'w 

0.0 

0.0 

M'q 

-0.20 

-0.718  ft-lbf-sec 

d'y-M'q) 

+0.072 

+0.6  ft-lbf-sec2 

M'0 

-0.106 

-0.163  ft-lbf 

M's 

-0.184 

-0.283  ft-lbf 
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In  order  to  nondimensionalize  the  equation  coefficients,  reference 
dimensions  must  be  selected.  Although  the  model  length  is  30  inches  overall, 
a  value  of  28  inches  was  used  as  the  reference  length.  This  length  had  been 
used  during  preliminary  research  of  this  vehicle  shape  to  account  for  the 
rounding  of  the  vehicle  nose  and  the  open  spacing  of  the  tail  section  in  the 
vicinity  of  the  rudders  and  dive  planes.  The  reference  mass  is  1.539  slugs. 
The  reference  force  is  0.6596  lbf.  Table  2  and  Figure  23  give  a  listing  of 
principle  dimensions  and  reference  parameters. 

TABLE  2.  REFERENCE  PARAMETERS 

Parameter  Value 

length,  L  28.0  inches 

mass,  m  1.539  slugs 

fwd  velocity,  U  1.0  ft/sec 

height,  T  3.5  inches 

breadth,  B  7.0  inches 

force,F  (m*lj2/L)  0.6596  lbf 

moment,M  (F*L)  1 .539  ft-lbf 

a.    Rotary  Moment  of  Inertia  Coefficient,  (I'y-M 'a) 

From  initial  calculations,  and  verified  by  swing  test  data,  it  was 
determined  that  the  moment  of  inertia  in  air  was  0.2  ft-lbf-sec^.  The  added 
mass  contribution  was  about  0.4  ft-lbf-sec^  giving  a  total  value  of  0.6  ft-lbf- 
sec^.  The  nondimensional  value  becomes  0.072. 
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b.    Drag  Coefficient,  Z\y,  and  Coupled  Moment  Coefficient,  Mw, 
for  Bare  Hull 

When  a  linear  velocity  in  the  'z'  direction  exists  in  unison  with  a 

forward  velocity  in  the  V  direction,  the  hull  will  act  as  an  airfoil  under  an 

angle  of  attack  to  the  fluid  stream.  This  is  because  the  total  velocity  vector 

will  be  acting  at  an  angle  of  attack  to  the  hull.  The  aspect  ratio  of  the  hull  was 

taken  as  the  breadth  to  length  of  the  bare  hull,  or  B/L=  7.0/26.5  =  0.264.  The 

Jones  Formula  was  used  to  estimate  the  derivative  of  the  lift  coefficient. 

There  will  be  some  error  at  this  value  of  aspect  ratio  when  using  this  formula 

but  it  was  considered  sufficiently  accurate  for  this  simulation.  Figure  41  of 

Reference  8,  pg.  501,  shows  that  the  Jones  Formula  begins  to  lose  accuracy  at 

values  of  about  0.2  for  aspect  ratio.  The  force  which  results  from  a  velocity 

in  the  positive  direction  of  'z'  will  be  a  resisting  force  and  hence,  negative  in 

sign.  Z'w  was  found  to  be  -0.83.  For  calculation  of  M'w»  equation  54  of 

Reference  8  was  utilized.  Approximating  the  model  as  an  ellipsoid  allows  the 

determination  of  coefficients  necessary  to  calculate  the  Munk  moment.  This 

moment  is  a  result  of  the  fact  that  an  elongated  ellipsoid  body  at  some  angle 

of  attack  in  a  nonviscous  fluid  will  experience  a  couple  which  tends  to 

increase  the  angle  of  attack.  An  equivalent  diameter  for  the  vessel  was 

determined  from  the  value  of  the  cross-sectional  area  at  the  mid-section.  This 

was  taken  as  the  length  of  an  ellipsoid's  minor  axis.  The  bare  hull  length  of 

26.5  inches  was  taken  as  the  length  of  the  major  axis.  In  this  particular  case, 

the  point  at  which  the  force  resulting  from  Z'w  acts  is  assumed  to  be  aft  of  the 

mid-position  of  the  hull.  This  is  where  it  acts  for  a  deeply  submerged 

ellipsoid.  The  reason  for  this  is  the  assumption  that  vortices  will  only  be 
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formed  on  the  downstream  side  of  the  tail  section  of  the  body,  as  is  the  case  for 
the  deeply  submerged  ellipsoid.  For  surface  ships,  the  position  at  which  the 
force  acts  is  often  taken  to  be  forward  of  the  mid-section.  The  sharpness  of 
some  ship's  bows  may  generate  vortices  in  a  manner  similar  to  the  stem.  The 
value  of  M'w  determined  in  this  manner  was  +0.12.  Alternately,  the  hull  could 
be  treated  as  an  airfoil.  This  is  not  too  bad  of  an  assumption  when  considering 
the  hull  form  of  this  particular  vehicle.  The  distance  aft  of  the  nose  at  which 
the  vertical  force  acts  is  assumed  to  be  one  quarter  of  the  hull  length.  This 
results  in  a  value  of  M'w  of +0.18.  Since  the  value  of +0.12  is  more 
conservative,  it  was  used  in  the  simulation.  The  positive  value  indicates  that 
downward  (+'z')  motion  results  in  a  counterclockwise  rotation.  1 

In  the  determination  of  Z'w  and  M'w  for  the  control  planes, 
values  of  the  lift  coefficient  derivative  were  calculated  by  using  equation  23 
of  Reference  8.  The  large  values  of  aspect  ratio  for  the  control  planes 
necessitates  use  of  this  method  since  the  Jones'  Formula  can  only  be  used  with 
accuracy  at  values  of  aspect  ratio  less  than  about  0.2.  The  values  of  (Z'w)f  aft 
and  (Z'w)f  fwd  were  added  directly  to  the  bare  hull  value.  This  gave  a  total 
value  of  -1.295.  The  moment  coefficients  which  result  from  the  fins  were 
calculated  by  multiplying  the  direct  derivatives  by  the  moment  arms  through 
which  they  act.  These  moment  arms  were  assumed  to  act  from  the  center  of 
gravity  of  the  model  to  the  center  of  pressure  for  the  fins.  The  centers  of 
pressure  were  assumed  to  be  at  one  quarter  of  the  mean  span  distance  from 
the  leading  edge.  The  forward  fins  create  a  positive  moment  and  the  aft  fins  a 


1  Right  hand  coordinate  system  with  positive  Y  axis  moving  to  the  right 
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negative  moment.  The  total  value  of  M'w  is  +0.088.  The  positive  sign 

indicates  this  will  be  a  stabilizing  moment. 

c.     Rotary  Damping  Coefficient,  Mq 

The  method  of  estimating  this  term  was  to  assume  the  vessel  to 
have  a  block  shape  and  was  rotating  about  its  centerline.  Details  of  this 
approach  are  shown  in  the  following  chapter.  The  forces  acting  were  found 
by  assuming  a  V^  drag  law  where  'V  is  the  average  velocity  acting.  The 
forces  were  assumed  to  act  at  the  centroids  of  the  velocity  triangles  thus 
giving  a  moment  arm  equal  to  two  thirds  of  the  length,  L.  A  plot  of  moment 
vs.  angular  rate  was  made.  This  curve  was  quadratic  in  nature  and  was 
approximated  with  a  linear  curve.  The  slope  of  this  line  was  taken  to  be  the 
damping.  This  resulted  in  -0.06  ft-lbf-sec/rad,  a  very  small  value  of 
damping.  Nondimensionalized,  this  gives  -0.02.  The  derivative  of  the 
quadratic  curve  evaluated  at  some  point  would  also  give  a  value  of  the 
damping  coefficient.  The  question  to  answer  is  where  on  the  curve  should  the 
derivative  be  evaluated.  For  the  simplified  controller  simulation  it  was  not 
critical  since  rate  feedback  was  used  in  the  control  scheme  to  give  adequate 
plant  performance.  For  the  DSL  simulation  the  value  of  M'q  was  found  using 
the  methods  of  naval  architecture  engineering  as  described  in  Reference  8. 
The  value  of  the  prismatic  coefficient,  needed  to  approximate  the  position 
where  the  bare  hull  linear  force  coefficient,  Z'w>  is  acting,  was  calculated  to 
be  0.7915.  A  total  nondimensional  rotary  damping  coefficient  of  -0.20 
results.  This  is  a  factor  of  10  greater  then  the  value  found  by  the  previous 
over-simplified  method.  For  this  reason,  the  DSL  simulation  was  conducted 
for  two  values  of  M'q. 


45 


d.  Restoring  Moment  Coefficient,  M'0 

This  is  a  very  important  coefficient  because  of  its  effect  in 
counteracting  control  plane  induced  moments.  It  also  acts  to  return  the  vehicle 
to  an  upright,  horizontal  position  when  control  induced  moments  are 
removed.  The  restoring  moment  arm  which  results  from  an  angle  of 
inclination,  0,  will  be  the  distance  between  the  center  of  bouyancy  and  the 
center  of  gravity  (  BG  )  multiplied  times  sin0.  A  small  angle  approximation 
was  used.  This  allows  dropping  the  sine  function.  Taking  the  derivative  with 

respect  to  the  angle  of  inclination  gives  a  value  of  the  coefficient  equal  to  the 
distance,  BG.  After  nondimensionalizing,  M'0  equals  -0.106. 

e.  Linear  Added  Mass  Coefficient,  Z'^ 

Reference  3  gives  formulae  for  determining  values  of  added 

mass  for  various  3-dimensional  bodies.  By  assuming  the  model  consisted  of 

various  shapes,  the  added  mass  values  were  approximated.  The  value  of 

added  mass,  Dm,  was  calculated  to  be  about  1.0  slug.  This  gives  a  value  of 
Z'^  of  -0.65. 

f.  Rotary  Lift  Coefficient,  Z'q 

This  term  consists  of  components  from  the  Munk  moment,  bare 
hull  damping  coefficient  and  the  fin  damping  coefficients.  It  descibes  the  net 
effect  of  applying  a  rotary  motion  to  the  model.  Z'q  was  calculated  to  be 
-0.20.  The  minus  sign  indicates  that  positive  rotary  motion  tends  to  lift  the 
vehicle  in  the  negative  'z'  (upward)  direction.  This  is  an  important  result. 
When  the  vessel  rotates  in  the  negative  pitch  direction,  such  as  when  diving  to 
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increase  depth,  the  resulting  linear  force  will  be  in  the  downward  sense 
giving  rise  to  an  acceleration  and  velocity  in  the  desired  direction. 

G.   SIMPLIFIED  CONTROLLER  SIMULATION 

The  simplified  controller  simulation  assumes  a  plant  where  the  only 
hydrodynamic  derivatives  acting  are  (I'y-M 'a)  and  Mq.  This  plant  is 

controlled  using  proportional  plus  derivative  control  techniques.  Program 
T6  of  Appendix  C  is  a  DSL  simulation  program  that  describes  this  controller. 
The  proportional  gains  Kpz  and  Kpy  are  set  by  design  considerations  of 
maximum  desired  commanded  pitch  angle  and  maximum  dive  plane  angle 
available.  Table  3  gives  the  correlation  between  variable  names  and  values. 
Figure  CI  shows  the  system  block  diagram  and  Figures  C2  through  C9 
present  the  effects  of  varying  the  derivative  gain,  Kdz,  from  a  low  value  of 
0.25  to  a  high  value  of  1.0.  The  optimum  value  appears  to  be  about  0.6.  No 
overshoot  occurs  and  the  depth  remains  within  3.5%  of  command  depth 
subsequent  to  the  rise  time  of  about  12.5  seconds. 


TABLE  3.    SIMPLE  MODEL  COEFFICIENTS 


Controller  Simulation 

Value 

Hvd  Deriv 

Ky 

-0.14 

Mg 

Jy 

0.6 

d'y-M'q) 

By(Beff=-0.34) 

-0.06 

Mq 

Value 
-0.283 

0.6 

-0.718 


The  simulation  shows  that  the  proposed  controller  technique 
should  be  adequate  for  this  vehicle  configuration.  The  next  logical  step  in  the 
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simulation  is  to  add  to  the  equations  of  motion  the  restoring  moment,  a 

stabilizing  effect,  and  the  heave  equation  contribution  to  depth  change.  This 

may  remove  the  requirement  for  rate  feedback  and  lower  the  value  of 

derivative  gain  needed  to  prevent  overshoot.  Although  the  restoring  moment 

will  tend  to  reduce  the  achieved  pitch  angle  for  a  given  dive  plane  rotation, 
the  value  of  M'5  calculated  using  the  techniques  of  Reference  1  is  about  twice 

as  large  as  the  value  used  in  the  controller  simulation.  As  a  consequence  of 
substituting  this  larger  value  of  M'5  into  the  simulation  equations,  some 

compensation  for  the  negative  effect  of  the  restoring  moment  term  will 
occur.  Further  simulation  studies  are  not  necessary  at  this  point  since  actual 
vehicle  characteristics  are  expected  to  vary  from  theoretical  predictions.  It  is 
noted  that  the  DSL  simulation  presented  in  Appendix  B  indicated  oscillations 
in  pitch  angle,  accelerations  and  velocities  even  when  all  hydrodynamic 
coefficients  were  considered.  Refer  to  Figures  Bl  through  B3.  Actual 
damping  is  expected  to  be  larger  than  any  calculated  simulation  value  and 
along  with  the  inertia  coefficient,  dominate  vehicle  response. 

With  the  restoring  moment  acting,  the  revised  closed  loop 
transfer  function  becomes: 


G7  = 


Z(s)_ (KyKpyU)(Kpz  +  KdzS) 

5(s)  "  {JyS3+BeffS2+[(KyKpy+Me)+KdzKyKpyU]S+KpzKyKpyU} 
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III.      DESIGN  OF  TEST  MODEL  AND  FACILITY 

A.  INTRODUCTION 

This  chapter  describes  the  methods  used  to  determine  the  size  and 
construction  of  the  test  model.  The  size  of  the  test  model  was  directly 
influenced  by  the  availability  and  size  of  the  test  facilities.  Some 
approximations  were  made  with  regard  to  design  parameters  and  will  be 
noted  where  appropriate. 

B.  MODEL  SIZE 

In  order  to  facilitate  handling  and  minimize  construction  costs,  it  was 
desirable  to  limit  the  size  to  something  which  was  carryable  by  hand.  The  test 
tank  size  was  the  most  important  controlling  parameter.  To  minimize  the 
influence  of  tank  sidewalls  on  the  model  hydrodynamic  characteristics  it  was 
necessary  for  the  model  to  have  a  maximum  width  not  more  than  eight 
inches.  The  test  model  width,  not  including  forward  dive  planes,  was  chosen 
to  be  seven  inches.  With  forward  dive  planes  the  model  width  was  eleven 
inches.  The  basic  vehicle  shape  was  chosen  to  be  similar  to  that  already  being 
studied  in  related  research.  The  breadth  was  set  at  twice  the  height  and  the 
length  at  roughly  7.5  times  the  height  not  including  the  screws,  rudders  or  aft 
dive  plane.  Thus,  the  ratio  of  body  dimensions,  T  *  B  *  L  ,  is  1  *  2  *  7.5  . 

C.  HULL  FABRICATION 

A  durable  but  easily  workable  material  was  needed  to  build  the  hull. 
Several  possible  materials  were:  aluminum,  wood,  fiberglass,  plastic.  It  was 
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decided  that  wood  was  not  satisfactory  since  the  vehicle  has  several 
penetrations  and  the  main  access  cover  would  be  removed  periodically  for 
controlling  the  operation  and  performing  maintenance  or  adjustments. 
Because  of  ease  of  construction,  and  adaptation  if  weight  became  a  problem, 
it  was  decided  to  use  aluminum. 

Hull  thickness  was  determined  by  approximating  the  hull  surfaces  as  flat 
plates  under  a  uniform  pressure  distribution.  Utilizing  the  following 
equation  for  stress,  S  =  kwLZ/t^,  where; 

S  =  stress 

k  =  constant  (=0.5) 

w  =  uniformly  distributed  load 
L  =  length  of  plate 
t  =  plate  thickness 
with  a  design  pressure  of  5  psi  (=10  ft.  water  depth)  and  a  shear  stress  of 

30,000  psi  for  aluminum,  the  minimum  plate  thickness  could  be  calculated 
[Ref.  1].  The  largest  surface  areas  of  uniform  thickness  are  the  upper  and 
lower  surfaces  of  the  midsection.  Because  of  bulkhead  and  joint  construction 
needed  to  join  the  sidewalls  to  the  upper  and  lower  surfaces  and  to  join  the 
model  sections  together,  an  area  less  than  actual  vehicle  dimensions  was 
assumed.  The  length,  L,  was  selected  to  be  16  inches  and  the  width,  b,  6 
inches.  Based  upon  the  value  of  the  ratio,  L/b  ,  of  2.67  the  value  of  the 
constant,  k,  was  chosen  as  0.5  by  rough  interpolation  of  'k'  values  in  Table 
20,  pg  5-69,  of  Reference  1.  Solving  the  above  stress  equation  for  ¥  results 
in  a  thickness  of  0.146  inches.  Because  of  the  already  conservative  design 
limit  for  depth  of  10  feet,  a  slightly  smaller  but  standard  dimension  of  1/8 
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inch  was  selected.  From  a  fabrication  viewpoint  this  thickness  would  also  be 

relatively  easy  to  work  with. 

A  flexure  formula  for  a  flat  plate  with  fixed  sides  was  then  used  to 

determine  maximum  centerline  deflection  under  load  [Ref.  1], 

deflection,  5  =  kiwb4/Et3  ,      ki=0.028 

Using  E=10  x  10"  psi,  the  maximum  flexure  is  about  0.01  inches.  A  1/2  inch 
long  boss  is  used  for  each  forward  dive  plane.  To  prevent  deflections  of  more 
than  0.001  inch  at  the  boss,  centerline  deflection  must  be  limited  to  0.007 
inches.  The  0.001  ir;ch  is  a  design  limit  to  minimize  possible  binding  of  the 
control  shafts.  The  top  of  the  midsection  is  the  access  cover  for  which 
deflection  is  not  critical.  There  are  no  components  mounted  to  it.  As  an  added 
precaution  to  prevent  midsection  bottom  deflection  with  corresponding 
possible  component  misalignment  problems,  strengthening  beams  were 
added.  Utilizing  the  deflection  equation  for  a  beam  with  fixed  supports  from 
Reference  2,  and  assuming  all  load  carried  by  the  beams,  the  beam 
dimensions  could  be  determined. 

y  =  wL3/384EI,    y  =  0.007  in. 

I  =  bh3 

b  =  beam  width 

h  =  beam  height 

E  =  10  x  106  psi 

L  =  6  inches 

w  =  load  =  5  psi  x  6"  x  16"/(n+l) ,  where 

n  =  the  number  of  beams 
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The  variables  are:  n,  b  and  h.  It  was  desirable  to  keep  the  height,  h,  of  the 
beam  as  small  as  possible  to  minimize  loss  of  internal  space.  The  height 
selected  was  0.25",  or  1/8"  thickness  in  addition  to  the  skin  thickness  of  1/8". 
This  results  in  a  beam  width  of  about  one  inch.  Various  numbers  of  beams 
were  analyzed.  As  'n'  increases  V  decreases,  but  the  total  beam  cross- 
sectional  area,  and  hence  volume,  increases.  Since  the  design  is  already 
conservative,  there  was  a  desire  to  minimize  weight.  Two  beams  of  cross- 
sectional  area  equal  to  0.25"  x  1.00"  were  added. 

D.   CALCULATION  OF  DISPLACEMENT  AND  FIRST-ORDER 
SYSTEM  COEFFICIENTS 

The  forward  section  has  parabolic  plane  sections  as  viewed  from  top  and 

side.  An  approximation  of  the  volume  was  made  by  assuming  a  prismatoid 
shape.  Thus,  Vf  =  h(Bj  +  4M  +  B2V6  where; 

Vf    =  volume  of  forward  section 

B 1    =  area  of  lower  base 

M     =  area  of  midsection 
B2    =  area  of  upper  base 

resulting  in  a  volume  of  approximately  37  uv>.  The  midsection  volume  was 
17  *  7  *  3.5  =  416.5  in^.  The  stem  has  a  triangular  cross-section,  as  viewed 

from  the  side,  and  has  a  volume  of  73.5  in^.  This  gives  a  total  volume  of  527 
in-\  Using  a  specific  weight  of  water  of  62.4  lbf/ft^,  the  displaced  weight  is 
about  19  lbf.  With  the  weight  of  each  section  and  the  point  through  which  it 
acts  known,  the  center  of  bouyancy,  CB,  was  estimated  for  the  model.  The 
CB  was  found  to  be  0.7  inches  aft  of  the  geometric  center  of  the  midsection. 
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An  initial  approximation  of  the  model  mass  moments  of  inertia  in  air 
were  made  by  assuming  the  basic  shape  of  a  rectangular  parallelepiped.  The 
formula  for  this  shape  is:  J=m(b2+12)/12  .  The  following  values  were 
obtained  using  effective  dimensions  of  3.5"  *  24"  *  7"  .  The  length  of  twenty- 
four  inches  was  selected  in  order  to  account  for  the  rounded  nose  section  and 
the  low  mass  per  unit  area  of  the  last  four  to  five  inches  of  the  stern  section. 

Jym  =  0.201  ft-lbf-sec2 
Jxm  =  0.021  ft-lbf-sec2 
Jzm  =  0.213  ft-lbf-sec2 

Added  mass  values  for  each  axis  of  rotation  were  determined  by 
approximating  the  model  as  a  rectangular  box  in  each  plane  of  motion. 
Reference  3  gives  added  mass  equations  for  three-dimensional  rectangular 
shapes.  When  determining  pitch  moment  a  value  of  twenty-eight  inches  was 
assumed  for  the  length.  This  helps  to  account  for  the  dive  planes.  For  a 
square  plate  of  side  length,  A,  and  thickness,  B,  the  added  mass  equation  is 
Am=kpA2B  where  Tc'  is  dependent  upon  the  ratio  B/A. 

B/A  k 


0.5 

1.32 

1.0 

0.70 

2.0 

0.35 

The  added  mass  in  pitch  was  calculated  by  assuming  four  blocks  of 
7"  *  7"  *  3.5".  This  gives  each  block  a  B/A  ratio  of  0.5.  The  total  added  mass 

value  for  the  four  blocks  was  calculated  to  be  1.016  slugs.  An  added  mass 

moment  of  inertia  value  for  pitch  was  then  calculated  to  be  about  0.490  ft- 
lbf-sec2.  This  gives  a  total  mass  moment  of  inertia,  Jy,  of  0.691  ft-lbf-sec2. 
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Because  of  the  crude  approximations  and  expecting  the  actual  vehicle  shape 
to  have  an  added  mass  below  this  value,  Jy  was  set  equal  to  0.60  ft-lbf-sec^. 

The  added  mass  terms  for  the  other  two  axes  were  determined  in  the  same 
manner.  Results  are  summarized  in  Table  4. 

TABLE  4.    TOTAL  INERTIA  FOR  'X'  AND  'Z  AXES 


Axis 

Block 
Dimensions 

B/A 
Ratio 

#  Blocks 

AM 

(slugs) 

J 
(ft-lbf-sec2) 

z 

X 

3.5*3.5*7.0 
3.5*3.5*3.5 

2.0 
1.0 

7 
14 

0.236 
0.472 

0.30 
0.04 

Values  of  viscous  damping  were  calculated  by  assuming  flat  plates  in 

uniform  flow  streams.  A  drag  coefficient  for  a  plate  normal  to  the  flow  was 

assumed  to  be  1.2  [Ref.  4].  The  drag  force  for  a  plate  rotating  about  its 
centerline  was  assumed  to  be  of  the  form  2P  AV^Cd-  The  average  plate 

velocity  was,  used  in  this  equation.  The  rotation  is  assumed  to  produce  a 
couple  acting  through  the  centroids  of  the  triangular  velocity  distributions 
located  on  each  side  of  the  center  of  rotation.  This  gives  a  moment  arm,  V, 
equal  to  two  thirds  of  the  plate  length.  In  terms  of  the  angular  velocity,  a  , 
the  linear  velocity  is  r*a.  This  results  in  an  expression  for  the  moment  due  to 
viscous  damping  of  the  form;  N  =  C  *  or.  Then  the  damping  term  is  equal  to 
C  *  a.  For  a  first  approximation  of  damping,  the  value  of  a  is  determined  by 
plotting  the  moment  vs.  angular  rate  and  then  approximating  the  resulting 
quadratic  relation  by  a  linear  one.  The  slope  of  the  linear  approximation  is 
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the  value  of  damping.  The  average  value  of  velocity  used  in  the  drag  force 
equation  is  given  by  vavg  =  j  *  a  .  This  gives  a  final  form  for  the  moment 

equation  in  terms  of  the  angular  rotation  rate,  a. 


N  = 


pCDAL3a2 


96 


The  variable  'A'  is  the  total  plane  area.  As  shown  in  Figures  24  through  26 
the  resulting  values  of  damping  will  be  quite  small.  The  damping  coefficients 
are  the  values  of  slope  for  the  linear  curve  approximations,  divided  by  100  to 
account  for  the  scale  factors.  This  is  a  crude  method  of  approximating 
damping. 
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Figure  24     Damping  About  'Y'  Axis 


55 


o 

X 

X> 


c 
<o 

E 
o 


o 
G 


c 
u 

e 

i 


2- 


1  - 


100 
80  - 
60- 
40- 
20  - 


y  =  +0.007xA2    R  =  1.00 


y  =  0.105x    R  =  1.00 


1 • 1 

10  20 

Roll  Rate  (rad/sec)  (x  100) 


3^ 


Figure  25      Damping  About  'X'  Axis 
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Figure  26     Damping  About  'Z'  Axis 

The  values  of  the  damping  coefficients  are:  Bx  =  0.001,  By  =  0.06  and 
Bz  =  0.03  ft-lbf-sec/rad.  If  the  equations  relating  angular  rates  to  damping 
moments  are  linearized  about  a  particular  point  and  then  evaluated  at  that 
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point,  the  hydrodynamic  derivative  Mq  associated  with  rotational  velocity  in 

the  pitch  equation  will  result.  For  example;  if  the  pitch  equation  is  linearized 
about  a  =  0.15  and  1.0  rad/sec  the  following  values  for  Mq  result: 

N  =  0.418  a2  =  f(oc) 
M  =  f(a)  +  f  (a)(a-a) 
M  =  f  (a)cc  +  Constant 

|^=f(a)  =  Ma  =  Mq 

a  =  0.15        Mq  =  0.1257 
a  =1.0  Mq  =  0.836 

Nondimensionalizing  gives  values  of  0.035  and  0.233.  This  indicates  that  the 

point  at  which  the  hydrodynamic  derivative  is  evaluated  strongly  impacts  the 

value.  This  is  as  expected.  The  value  used  for  simulation  studies  must  be 

chosen  carefully. 

E.   MOTOR  REQUIREMENTS 

The  determination  of  power  requirements  for  the  model  were  based 
upon  an  approximation  of  the  drag  forces  acting  on  the  vehicle.  The  speed 
range  of  the  vehicle  was  selected  as  0.0  to  5.0  ft/sec.  The  drag  forces  were 

calculated  in  several  ways.  The  possible  conditions  assumed  were: 

1)  Skin  friction  dominant 

a)  Laminar  flow 

b)  Turbulent  flow 

2)  Pressure  drag  dominant 

3)  Model  approximated  as  8:1  ellipsoid 

4)  Model  approximated  as  blunt  nosed  elongated 

cylindrical  body  in  longitudinal  flow 
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Equations  for  drag  coefficients  were  taken  from  Reference  5.  Table  5  lists 
the  variables  used  and  their  definitions. 

TABLE  5.    DRAG  COEFFICIENT  DEFINITIONS 
Cflfo         Base  drag  coefficient 

Cf  Skin  friction  drag  coefficient 

Cfb  Forebody  drag  coefficient 

Sfb  Forebody  wetted  surface  area  (460  in^) 

S™,  Total  wetted  surface  area  (672  in^) 

Cross-sectional  area  (24.5  in^) 
Reynolds  number  based  on  model  length 


'w 

Ab 
Rei 


Reynolds  number  calculations  were  based  on  flat  plate  approximations. 

For  a  speed  of  5  ft/sec  and  plate  lengths  of  17",  20.5"  and  28",  Reynolds 

number  varied  between  5x10^  and  10  x  10-\  The  following  equations  were 

used: 

Cf  =  1 .33/SQRTtRei]  Cf  =  0.043/tRej]  ^6 

Cfb  =  Cfsfb/Ab  cdb  =  0.029/SQRTtCfb] 

Table  6  gives  values  of  drag  coefficients  for  Reynolds  number  based  upon  a 
plate  length  of  21  inches. 

TABLE  6.    VALUES  OF  DRAG  COEFFICIENTS 


V(ft/sec) 

Re^xlO5) 

Cf(lam) 

Cf(turb) 

cdb 

cfb 

1.0 

1.4 

0.004 

0.006 

0.09 

0.11 

2.0 

2.8 

0.003 

0.005 

0.10 

0.09 

3.0 

4.2 

0.002 

0.005 

0.10 

0.09 

4.0 

5.6 

0.002 

0.005 

0.10 

0.09 

5.0 

7.0 

0.002 

0.005 

0.10 

0.09 
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For  laminar  flow  a  maximum  power  of  about  1.6  watts  results.  Turbulent 
flow  gives  3.9  watts  at  five  ft/sec.  Combining  forebody  drag  and  base  drag 
coefficents,  which  are  based  on  the  base  area,  along  with  the  turbulent  flow 
skin  friction  coefficient  acting  over  the  wetted  surface  area  of  the  stem,  a 
power  requirement  of  about  6.5  watts  results.  Using  a  coefficient  of  drag  of 
0.2,  which  seems  reasonable  based  upon  Figure  3.18  of  Reference  5,  or  for 
an  8:1  ellipse  as  given  in  Reference  6,  the  total  power  requirement  is  about 
5.8  watts.  It  was  desired  that  the  motor  power  be  able  to  compensate  for 
induced  drag  from  control  surfaces  along  with  the  frictional  or  pressure 
drag.  For  this  reason,  the  size  of  the  control  surfaces  must  be  known.  Control 
surface  sizing  is  dependent  upon  the  maximum  expected  rate  of 
maneuvering.  In  order  to  arrive  at  a  rough  approximation  of  the 
maneuvering  speed,  some  simple  idealizations  were  made.  Assuming  for  the 
moment  that  the  motion  along  the  'z'  axis  is  acting  after  the  input,  or 
disturbing  force,  has  died  away;  the  governing  equation  is  given  by: 

mz  +  bz  +  kz  =  0 
The  value  of  damping  was  considered  negligible.  Solving  for  the  linear 
acceleration  and  substituting  with  equivalent  angular  acceleration, 

[X0  =  -  z],  the  following  relation  results:  0  =  co^Z/X.  The  natural 
frequency,  co,  can  be  written  in  terms  of  the  period  of  the  maneuver.  This 

gives  a  final  form  of  the  equation  as:  0  =  Z(2tc)2/Ut3.  The  period  of  the 
maneuver  was  set  equal  to  the  distance  traveled  divided  by  the  forward 
velocity,  U.  The  moment  arms  through  which  the  forward  and  aft  dive  plane 
surfaces  were  acting  were  set  at  16.375  inches  (1.36  feet)  for  the  aft  dive 
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plane  and  7.6  inches  (0.63  feet)  for  the  forward  dive  planes.  This  gives  a 
governing  equation  of  the  form: 

0.63F!  +  1.36F2  =  JyZ(2rc)2/UT3  (4) 

Fl  is  the  force  generated  by  the  forward  dive  planes  and  F2  is  the  force 
generated  by  the  aft  dive  planes.  To  perform  a  1.5  foot  depth  change  in  a 
horizontal  distance  of  8  feet,  at  a  velocity  of  1  ft/sec,  the  required  moment 
was  0.07  ft-lbf  with  T  =  8  seconds.  In  order  to  solve  this  equation,  one  of  the 
forces  had  to  be  estimated.  The  control  plane  areas  were  based  on  a 
freestream  velocity  of  one  ft/sec.  The  power  requirement  for  a  propeller 
may  be  approximated  as  pQ(Vp-Vf)Vf  [Ref  6].  This  equation  was  then  set 

equal  to  the  drag  force  on  the  vehicle  in  steadystate  forward  motion.  Ap  is  the 
cross-sectional  area  swept  by  the  propeller  and  Q=[Ap(Vff Vp)]/2  where  Vf 
is  the  free-stream  velocity  and  Vp  is  the  velocity  downstream  of  the 
propeller.  For  a  velocity  of  one  ft/sec,  the  drag  force  was  found  to  be  about 
0.05  lbf.  At  this  stage  of  the  design  the  propeller  diameters  were  not  known. 
Therefore  a  reasonable  diameter  of  one  inch  was  assumed.  For  the  two 
screws,  the  total  area  was  1.571  in2.  The  total  deflected  area  was  assumed  to 
be  one  half  of  this,  A0  =  0.7854  in2.  Solving  the  propeller  power  equation 
for  Vp  gives  the  downstream  velocity  as  3.23  ft/sec.  This  velocity  was 

considered  to  act  upon  the  aft  dive  plane. 

The  forces  acting  on  the  dive  plane  positioned  at  some  angle,  9,  to  the 

horizontal  were  then  approximated  from  the  expressions: 

Fy  =  pA0Vp2sina  (5) 

-Fx  =  PAovp2cosa-PAovp  (6) 
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The  area,  A0,  is  the  cross-sectional  area  of  the  jet  which  has  been  deflected. 

The  angle  a  is  the  effective  deflection  angle.  This  angle  can  be  found  using 

simple  geometry.  The  velocity  leaving  the  plane  surface  is  taken  as  the 

propeller  velocity  and  is  added  vectorily  to  the  free  stream  velocity.  For  a 

deflection  of  15  degrees  on  the  control  plane,  an  effective  angle  of  about  1 1.5 
degrees  results.  Solving  equation  (5)  for  Fy  gives  0.022  lbf.  Solving  equation 

(4)  for  Fj,  with  F2  set  equal  to  Fy,  yields  a  forward  dive  plane  force  of 

about  0.064  lbf.  The  forward  dive  plane  area  was  approximated  by  utilizing 
the  equation  of  force  due  to  j  momentum  change;  F1  =  pAVf^sin(6/2). 

Solving  this  equation  for  area  gives  A  =  18.4  in^.  This  is  the  total  area  of  the 
two  forward  planes.  This  seems  unacceptably  large.  If  the  forward  velocity 
was  to  remain  the  same,  the  amount  the  dive  plane  was  allowed  to  rotate  had 
to  be  increased.  {Note:  Adding  the  force  which  results  from  the  area  of  the 
aft  dive  plane  which  does  not  see  any  propeller  thrust,  but  is  acted  upon  by 
the  freestream  velocity,  will  change  the  required  forward  area  by  only  a 
small  percent,  therefore,  it  was  not  included  in  the  calculations.  In  the  final 
design  the  aft  dive  plane  consisted  only  of  two  rectangular  sections  located 
directly  aft  of  the  screws. }  The  angle  of  attack  for  the  control  planes  was 
increased  to  30  degrees.  This  gives  an  effective  angle  of  attack,  a,  of  about  23 
degrees.  In  this  case,  F2  =  0.048  lbf  and  Fj  =  0.007  lbf.  This  gives  a  forward 

control  area  of  about  two  square  inches.  A  design  goal  was  established  to 
allow  30  degree  dive  plane  movement.  The  size  of  forward  dive  planes  was 
not  crucial  for  dive  control  but  will  effect  the  capability  of  roll  control.  A 
search  for  prefabricated  control  surfaces  and  screws  for  model  submarines 
resulted  in  the  discovery  of  components  which  had  potential  for  use. 
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Forward  dive  planes  of  roughly  4.75  in^  each  and  screws  with  a  diameter  of 

about  one  inch  were  located.  These  components,  along  with  associated 

shafting,  stuffing  tubes  and  control  links  were  adapted  to  the  test  model. 

With  the  control  surface  sizes  set,  the  induced  drag  could  be  calculated. 

For  the  forward  dive  planes;  a  drag  force  of  about  0.009  lbf  was  calculated 

using  equation  (6),  with  a  total  cross-sectional  area  given  by  (9.5sin30)  in^ 
and  Vp  set  equal  to  a  freestream  velocity  of  one  ft/sec.  The  drag  due  to  the  aft 

dive  plane  is  calculated  in  the  same  manner  but  with  a  jet  velocity  of  3.23 
ft/sec  and  an  area  of  1.571  in^.  The  resulting  drag  is  =  0.03  lbf  (2.8  watts).  A 

total  drag  force  of  0.039  lbf  exists  at  one  ft/sec  freestream  velocity  due  to 
control  planes  at  maximum  deflection.  Assuming  power  is  directly 
proportional  to  velocity  cubed,  the  power  at  five  ft/sec  is  equal  to  the  power 
at  one  ft/sec  times  125.  This  gives  a  power  of  4.875  ft-lbf/sec,  or 
equivalently,  about  6.6  watts.  Added  to  the  6.5  watts  calculated  previously,  a 
sub-total  requirement  of  13.1  watts  is  needed.  To  this  was  added  2.8  watts  for 
rudder  deflection.  Since  the  efficiency  of  the  propellers  is  not  known  but  is 
expected  to  be  relatively  low,  say  50%,  the  total  power  needed  to  maintain 
maximum  design  speed  with  all  control  surfaces  at  full  deflection  is  about  36 
watts.  This  is  a  relatively  small  power  requirement  and  can  easily  be  met. 
Two  standard  size  motors  specifically  designed  for  radio  controlled  models 
were  selected.  Although  rated  significantly  above  what  was  needed,  it  was 
decided  to  use  them  since  it  is  good  practice  to  operate  well  below  rated 
voltage  and  current.  Also,  and  most  importantly,  the  amount  of  frictional 
load  from  the  stuffing  tubes  was  unknown.  These  motors  were  each  rated  for 
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8  amps  at  12  volts  DC.  If  weight  became  a  significant  problem,  smaller 
motors  might  have  been  utilized. 

F.    GYRO  SELECTION 

In  order  to  measure  the  maneuvering  characteristics  of  the  vehicle  a 
suitable  motion  sensing  system  was  needed.  Various  alternatives  were  looked 
at.  Because  of  the  slow  rate  of  motions,  accelerometers  would  have  to  be 
sensitive  to  very  low  accelerations  such  as  0.05  to  0.2  ft/sec.  Some  low 
frequency  accelerometers  were  located;  however,  their  size  and  cost  were 
prohibitive. 2  For  a  larger  scale  model  or  prototype  vehicle,  inertial  sensors 
were  the  preferred  sensing  devices  because  of  their  sensitivity,  accuracy  and 
reliability.  Rate  gyros  had  been  considered  first,  and  because  of  the 
availability  of  low  cost  radio  controlled  model  gyros,  accepted  as  the  most 
likely  device  to  meet  the  test  requirements.  Various  RC  model  companies 
produce  gyros  as  well  as  the  associated  radio  control  equipment  such  as 
transmitters,  servos  and  speed  control  equipment.  To  ensure  compatibility, 
all  components  were  purchased  from  the  same  company  with  the  exception  of 
the  motor  speed  controller.  Three  gyros  were  purchased  and  mounted  in 
positions  to  allow  monitoring  of  angular  rate  around  each  coordinate  axis.  In 
the  test  model  installation,  the  gyro  output  signal  is  amplified  and  transmitted 
off  the  vehicle  to  the  recording  equipment  via  the  data  link  cable.  The  gyro  is 
used  only  as  a  sensor.  It  has  no  direct  control  function.  The  gyro  system  as 
purchased  was  a  closed  loop  system  within  which  the  gyro  signal  was  fed 
back  to  a  control  box.  The  control  box  also  had  the  input  reference  signal 


2High  quality  inertial  sensors  are  avaliable  from  Systran  Donner  Corporation 
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from  the  reciever.  The  reciever  recieved  the  radio  control  signal  from  the 
radio  control  transmitter.  Any  movement  sensed  by  the  gyro  produced  an 
output  signal  which  was  then  compared  to  the  reference  signal.  A  gain  setting 
on  the  control  box  allowed  adjustment  of  the  gyro  sensitivity.  A  servo 
control  signal  was  generated  that  would  then  feed  a  control  servo.  Movement 
of  an  operating  lever  (joy-stick)  on  the  radio  transmitter  would  also  generate 
an  output  signal  for  control  of  vehicle  movement. 

G.  PRESSURE  INSTRUMENTS 

Two  differential  pressure  cells  were  installed  in  the  model.  One  cell  was 
utilized  for  depth  measurements  and  the  other  cell  was  used  for  speed 
measurements  by  sensing  the  differential  pressure  from  a  pitot  tube  mounted 
in  the  nose.  The  cell  used  for  measuring  depth  has  a  range  of  0  -100  cm  of 
water.  The  pitot  tube  cell  has  a  range  of  0  -  2  cm  of  water. 

The  depth  was  initially  determined  by  sensing  outside  water  pressure 
through  a  port  located  17.5  inches  aft  of  the  bow.  The  port  was  located  on  the 
bottom  centerline  of  the  vessel.  This  pressure  was  sensed  at  the  pressure  cell 
high  pressure  port.  The  low  pressure  port  is  vented  to  the  vessel  interior.  It 
became  evident  during  testing  that  the  location  of  the  pressure  port  was 
inadequate.  This  could  have  been  foreseen.  Maneuvering  of  the  vehicle  in  the 
vertical  plane  caused  pressure  gradients  to  develop  which  were  of  sufficient 
magnitude  to  cause  errors  in  depth  readings.  Thus,  two  pressure  ports  were 
installed,  one  centered  on  each  side  of  the  model  located  14.5  inches  aft  of  the 
bow.  This  is  close  to  the  vehicle  midpoint.  The  ports  were  connected  through 
tubing  to  a  junction  box  which  was  connected  to  the  high  pressure  side  of  the 
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depth  cell  and  the  low  pressure  side  of  the  speed  cell.  The  original  port  was 
plugged. 

Initially,  the  vessel  speed  was  sensed  by  a  pitot  tube  located  in  the  nose  of 
the  vessel.  The  pitot  tube  design  proved  to  be  less  than  satisfactory.  Because 
of  the  method  of  construction,  the  stagnation  pressure  port  was  too  small  and 
the  nose  was  rounded  vs.  square  cut.  This  limited  the  dynamic  sensitivity  of 
the  pitot  tube.  A  thin  walled  sleeve  was  machined  to  fit  over  the  original 
design.  This  created  a  larger  stagnation  port  opening  and  reduced  the 
sensitivity  of  the  cell  to  any  pitot  tube  misalignment.  The  static  pressure  ports 
were  not  the  recommended  distance  from  the  stagnation  port  and  were  too 
close  to  the  vessel  body.  Although  the  pitot  tube  would  not  accurately  indicate 
speed,  it  was  hoped  it  would  still  be  useful  to  indicate  vessel  motion.  Pitot 
tube  operation  and  basic  theory  of  design  is  given  in  Reference  7.  During 
initial  vehicle  testing  it  was  discovered  that  the  small  porting  of  the  pitot  tube 
prevented  the  proper  sensing  of  speed.  The  pitot  tube  was  removed  and 
replaced  with  a  stagnation  pressure  port.  This  port  was  connected  to  the  high 
pressure  side  of  the  speed  DP  cell.  This  arrangement  appeared  effective  in 
providing  an  indication  of  vehicle  speed  during  level  flight,  however;  the  cell 
was  sensitive  to  pitch  angle.  The  sensing  tubes  did  not  fill  with  water  because 
of  their  small  size,  and  since  the  cell  had  a  small  range  of  only  0-2  cm,  the 
cell  output  would  saturate  quickly.  Lessons  learned  from  this  experience  was 
that  a  higher  range  DP  cell  might  prove  effective  in  providing  an  indication 
of  pitch  angle  provided  the  tubing  between  the  sensing  ports  and  the  cell 
remained  clear  of  water.  The  weight  of  the  air  columns  would  be  negligible. 
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Speed  was  finally  estimated  by  visual  clocking  of  the  model  over  a  known 
distance  by  use  of  a  stopwatch. 

H.   ELECTRONICS  AND  POWER 

The  Naval  Postgraduate  School  Mechanical  Engineering  Electronics  Lab 
contructed  the  necessary  electronic  circuits  to  provide  power  to  the  various 
internal  components.  Because  of  vehicle  size,  it  became  evident  that  a  power 
source  located  on  board  would  be  to  heavy.  Small,  but  relatively  high 
powered  batteries  were  available  for  powering  the  electronic  circuits, 
however,  an  external  power  source  had  to  be  used  for  the  drive  motors  and  it 
was  decided  to  regulate  this  DC  power  source  internally  to  the  vehicle  by  use 
of  small  DC-DC  voltage  regulators  for  the  electronics.  The  motors  were 
rated  for  12  volt  DC.  A  six  ampere  rated  DC  power  supply  unit  was  adjusted 
to  provide  12.0  volts  under  load  to  the  vehicle.  Batteries  were  not  carried 
aboard  the  vessel.  Figure  27  provides  the  layout  of  the  electrical  circuits.  The 
2.4  volt  regulated  DC  supply,  shown  in  the  lower  section  of  Figure  27, 
provided  power  to  the  gyro  sensory  circuits. 
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I.     TEST  TANK  CONTROL  STATION 

A  control  station  was  set  up  next  to  the  test  tank.  This  station  consisted  of: 
8-channel  stripchart  recorder,  analog  computer,  digital  computer, 
oscilloscope,  multimeter,  DC  power  supply  and  the  radio  control  box.  The 
control  station  allowed  monitoring  and  recording  of  radio  command  and 
vehicle  response  signals.  The  oscilloscope  and  multimeter  were  used  for 
monitoring  of  voltages  at  various  locations  of  interest.  Figure  28  indicates 
the  station  layout.  The  analog  computer  was  used  primarily  as  an  output 
'mpedance  buffer  and  signal  conditioner  between  the  radio  control  box  and 
the  digital  data  acquisition  system. 


TEST  TANK 


^V^l    TEST  MODEL 


DIGITAL  COMPUTER 


POWER  AND  DATA  LINK 


RADIO    CONTROL 
BOX 


DC  PWR  SUPPLY 


STRIPCHART 


Figure  26     Station  Layout 
Further  details  concerning  the  development  of  the  digital  data  acquisition 
system  are  provided  in  Reference  9. 
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IV.      CALIBRATION  AND  TEST  PROCEDURES 

A.  INTRODUCTION 

This  chapter  describes  the  methods  used  to  perform  equipment  and 
system  calibrations  as  well  as  the  test  procedures  used  to  acquire  vehicle 
command  and  response  data. 

Testing  and  calibration  of  components  utilized  basic  lab  equipment  such 
as  multimeters,  oscilloscope  and  stripchart  recorder.  An  analog  computer 
was  used  to  provide  buffering,  amplification  and  integration  of  signals.  The 
analog  computer  was  a  simple  means  of  providing  real  time  capability  to 
perform  operations  on  the  vehicle  response  signals  as  well  as  the  controller 
command  signals.  Several  methods  of  filtering  the  rate  gyro  outputs  were 
performed  as  a  means  of  removing  or  minimizing  the  effects  of  a  drifting 
bias  signal.  Both  first  order  and  second  order  filters  were  tested.  A  high  pass 
filter  can  be  produced  on  the  analog  computer  by  feeding  the  input  signal  to  a 
summer.  The  summer  output  is  then  fed  back  via  a  potentiometer  (pot), 
integrator  and  inverter  to  the  input  of  the  summing  amplifyer.  Adjustment  of 
the  pot  setting  and  the  amplifyer  gains  will  control  the  value  of  the  time 
constant.  The  filters  seemed  to  be  of  limited  value,  because  of  the  non- 
constant  bias,  and  the  final  solution  was  the  use  of  a  relay  comparator  to 
provide  a  dead  band. 

Two  test  tanks  were  used.  A  small  tank  of  about  three  feet  in  depth  by 
four  feet  in  length  was  utilized  to  adjust  ballasting  and  to  check  the  vehicle 
for  initial  leak  tightness.  A  large  water  tank  was  utilized  to  perform 
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operational  tests.  This  tank  was  about  4ft  x  4ft  x  40ft.  Fresh  water  was  used  in 
the  tanks. 

B.   GYRO  CALIBRATION 

A  calibration  test  was  first  needed  to  determine  whether  the  gyros  were 
sufficiently  sensitive  and  could  produce  relatively  clean  signals.  To 
accomplish  this  a  flat  circular  board  was  prepared  on  which  a  gyro  could  be 
mounted.  The  board  was  then  mounted  on  the  handwheel  of  a  mill  machine. 
This  allowed  relatively  fine  control  of  the  rotation  rate.  The  rate  was 
monitored  by  measuring  the  time  required  for  a  given  amount  of  wheel 
rotation.  For  calibration  purposes  the  reference  signal  was  generated  from  a 
DC  power  supply.  This  signal  was  fed  to  the  gyro  control  box.  The  gyro 
system  output  signal  was  then  fed  to  an  oscilloscope  and  multimeter  for 
analysis  and  recording.  Figures  29  through  31  show  that  for  rotation  rates  of 
several  rpm,  the  gyro  output  voltage  is  quite  linear.  These  figures  were 
obtained  by  measuring  the  output  of  a  mixer  circuit  which  included  a  signal 
processing  gain.  This  mixer  circuit  was  later  removed  so  the  results  of 
Figures  29  through  34  were  considered  preliminary  and  were  useful  only  in 
determining  linearity  and  sensitivity  of  the  low  cost  gyros. 
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Figure  29     Pitch-rate  Gyro 
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Figure  30     Yaw-rate  Gyro 
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Figure  31      Roll-rate  Gyro 
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Figure  32      Pitch-rate  Gyro  at  Low  Ref.  Voltage 
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Figure  33      Yaw-rate  Gyro  at  Low  Ref.  Voltage 


y=  -7.102  +  41.954X  R  =  0.98     y  =  5.456  +  35.757x  R  =  0.98 


200 


b 

a. 

b 

o 


100  - 


a     mVolts(CW) 
♦     mVolts(CCW) 


2  3  4 

AIL    (RPM) 


Figure  34     Roll-rate  Gyro  at  Low  Ref.  Voltage 
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This  data  corresponds  to  a  system  design  reference  signal  voltage  of  4.8 
volts.  The  same  tests  were  done  at  a  reference  voltage  of  about  4.35  volts. 
The  outputs  were  still  measurable  and  linear  as  shown  in  Figures  32  through 
34.  By  comparing  the  figures  it  can  be  observed  that  the  gyro  outputs  are 
quite  sensitive  to  reference  signal  voltage.  In  the  design  of  the  power  supply 
system  this  fact  had  to  be  taken  into  account.  If  voltage  fluctuations  occurred 
during  testing  the  calibration  curves  would  not  be  usable  for  determining 
angular  rates  of  motion. 

It  was  determined  during  cc  :.  uction  of  the  gyro  power  supply  system 
that  the  mixer  box  component  of  the  manufacturer  supplied  gyro  system  was 
in  fact  not  necessary.  The  mixer  box  was  needed  when  the  gyro  was  operated 
as  a  closed  loop  system  independent  of  the  vehicle  control  circuits.  It  was  part 
of  the  feedback  network  and  supplied  a  gain  amplifying  the  gyro  output. 
With  this  component  removed  the  previous  gyro  calibration  was  no  longer 
valid  and  a  new  calibration  of  the  entire  gyro  system  as  finally  used  was 
required.  Since  a  swing  test  had  been  set  up  for  mass  moment  of  inertia 
determination,  this  test  also  provided  the  means  for  gyro  calibration.  By 
recording  the  output  of  the  gyro  on  a  stripchart  the  frequency  of  oscillation 
could  easily  be  found.  The  vehicle  was  treated  as  a  point  mass  and  a  small 
angle  approximation  was  used.  The  equation  of  motion  then  becomes: 

9  +  C0n26  =  0  .  A  solution  of  this  equation  is:  0(t)  =  60sincont .  The  amplitude 
of  the  velocity  is  C0n6o  .  The  initial  angle,  Go,  was  measured  prior  to  release 

of  the  vehicle.  The  period  of  oscillation  was  measured  and  it  was  observed 
that  the  value  of  damping  was  quite  low.  Thus,  cod  =  (On  =  27C/T.  The  period, 

T,  was  measured  directly  off  of  the  stripchart  recording.  The  voltage 
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corresponding  to  the  maximum  velocity  was  also  measured  from  the 
stripchart  recording.  A  relation  between  voltage  output  and  rate  is  thus 
determined.  The  following  values  were  calculated. 
Pitch  Rate  Gyro:     12.5  mvolt-sec/degree 
Roll  Rate  Gyro:      18.6  mvolt-sec/degree 

C.   PRESSURE  CELL  CALIBRATION 

Power  was  applied  to  the  pressure  cells  for  a  period  of  about  20  minutes 
prior  to  calibration  checks.  This  allowed  the  electronic  circuits  to  reach 
normal  operating  temperature.  The  zeroes  were  set  by  adjustment  of  the 
zeroing  potentiometers  with  all  pressure  sensing  lines  vented  to  atmosphere. 

A  0  -10  inch  Micromanometer  Model  34  FB2TM  was  used  for  the  0  -  2 
cm  pitot  tube  pressure  cell.  The  manometer  level  could  be  read  to  0.001  inch 
water.  The  manometer  water  level  was  set  at  0.8  inches  (=  2  cm)  and  the  span 

adjust  potentiometer  adjusted  to  provide  10.0  volts  output.  The  zero  was  then 
readjusted  after  venting  the  system.  The  micrometer  level  was  adjusted  every 
0.1  inches  and  the  voltage  recorded.  Figure  35  shows  the  expected  linear 
output. 
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Figure  35     Velocity  Cell  Calibration  Curve 

A  0  -  120  inch  manometer  was  used  for  calibration  of  the  pressure  cell 
used  for  depth  measurement.  The  cell  output  was  0-100  centimeters.  This 
corresponds  to  about  39  inches  water.  The  same  procedure  used  for  the  other 
cell  was  used.  The  zero  was  set,  the  range  was  set  for  a  10.0  volt  output  at  39 
inches  of  water  and  then  the  zero  reset.  Water  level  was  adjusted  every  five 
inches  and  the  output  voltage  recorded.  Figure  36  shows  the  linear  behavior 
of  the  output.  During  operational  testing  it  was  determined  that  the  cell 
operation  was  not  satisfactory.  Speed  was  measured  by  clocking  the  vehicle 
over  a  known  distance.  The  motor  voltage  which  corresponded  to  each  speed 
was  recorded.  The  resulting  calibration  curve  is  shown  in  Figure  37. 
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Figure  36     Depth  Cell  Calibration  Curve  (Bench  Test) 
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During  operational  testing,  the  pressure  cell  used  for  measuring  depth 
was  checked.  This  was  performed  with  the  vehicle  in  its  final  assembled 
form.  The  previous  tests  were  bench  tests.  The  vehicle  was  set  in  the  test  tank. 
The  depth  was  varied  and  the  output  of  the  depth  pressure  sensor  monitored 
on  the  multimeter.  The  results  are  plotted  in  Figure  38. 
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Figure  38      Depth  Cell  Calibration  Curve 

As  can  be  seen  in  the  above  figure,  the  zero  of  the  pressure  ceii  has  shifted. 
The  slope  of  the  curve  has  remained  unchanged.  This  may  be  a  result  of  a 
change  in  the  power  supply  voltage  or  the  zero  adjust  pot  may  have 
accidentally  been  moved.  In  future  testing  the  pressure  cell  should  be  zeroed 
prior  to  performing  data  runs.  This  had  been  overlooked  during  the  data 
runs  performed  here,  but  did  not  effect  any  of  the  dynamic  response  results. 
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D.  BALASTING 

Following  vehicle  assembly,  all  joints  were  visually  checked  for  proper 
sealing.  With  the  access  cover  removed,  the  model  was  then  carefully 
lowered  into  a  small  water  tank  to  check  for  signs  of  gross  leakage  from 
shafting  and  other  hull  penetrations.  No  leakage  was  noted.  The  access  cover 
was  then  secured  in  place.  The  vehicle  was  the  placed  into  the  tank.  When 
floating  free,  about  1/2  inch  of  freeboard  forward  and  1/16  inch  aft  was 
observed.  The  model  had  a  slight  list  to  port  as  expected  because  of  the 
placerr ia  t  of  servos.  The  initial  displacement  weight  estimate  of  the  vehicle 
was  19  pounds.  This  was  determined  from  geometry  and  a  specific  weight 
for  water  of  62.4  lbf/ft^.  Individual  components  were  weighed  prior  to 
assembly.  A  total  weight  of  17.86  pounds  was  measured.  In  order  to 
submerge  the  vehicle,  about  two  pounds  of  weight  had  to  be  added  to  the 
model.  About  1.5  lbs  was  hung  from  below  and  an  additional  1/2  lb  added 
above.  The  assembled  dry  weight  of  the  model  without  ballasting  is  8.215 
kilograms  or  about  18  lbs.  An  accurate  measurement  of  the  vehicle  plus  the 
added  weight  for  submergence  indicated  a  total  weight  of  9.1 13  kg,  or  about 
20  lbs.  Thus,  two  pounds  of  ballasting  was  needed.  Slightly  more  than  one 
pound  of  ballast  was  prepared  from  lead  bars,  roughly  1/2  inch  square  by 
two  inches  long.  The  remaining  ballast  was  in  the  form  of  small  steel  shot. 
The  shot  could  be  placed  fore  or  aft  into  small  tube  sections  which  had  been 
glued  to  the  vehicle  interior  bottom.  The  vehicle  was  loaded  with  eight  lead 
bars  and  placed  in  the  water  tank.  A  slight  positive  buoyancy  was  evident. 
Steel  shot  was  added  in  an  iterative  process  until  the  vessel  was  very  close  to 
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neutral  bouyancy  while  maintaining  a  horizontal  position.  The  resulting 
final  displacement  weight  was  19.6  pounds. 

E.    MEASUREMENT  OF  Jx  AND  Jz 

The  mass  moments  of  inertia  were  estimated  in  Chapter  2.  It  was  desired 
to  perform  experimental  verification  of  these  values.  The  experiment  itself 
would  also  provide  a  means  of  monitoring  gyro  output  due  to  actual  vehicle 
motion.  The  test  consisted  of  suspending  the  model  from  a  pivot  point  thus 
allowing  pendulum  motion  around  the  pitch  axis  and  roll  axis.  This  was  done 
by  suspending  the  model  with  four  lines.  Two  lines  were  connected  to  the 
forward  dive  plane  shafts  and  two  lines  were  connected  to  the  upper  rudder 
support  beams  which  extend  from  the  fins.  The  four  lines  were  fed  through 
an  eyebolt  anchored  in  a  2  x  4  inch  wooden  beam.  Turnbuckles  were  installed 
in  each  of  the  aft  lines  to  allow  for  levelling  about  the  Y  axis.  Levelling 
about  the  'y'  axis  could  be  accomplished  by  lifting  on  one  end  of  the  vehicle 
allowing  the  support  wires  to  slip  through  the  support  eyebolt.  The  support 
wires  were  passed  through  the  eyebolt  twice  to  prevent  excessive  slipping 
when  the  full  weight  of  the  vehicle  rested  on  the  wires.  The  equation  of 
motion  describing  pendulum  motion  was  used  to  solve  for  the  mass  moment 
of  inertia.  A  small  angle  approximation  was  used.  The  governing  equations 
are: 

JoO  +  mgL9  =  0      cOj^  =  mgL/J0        t  =  27r/con 
Jo  =  mgLx2/47t2     J   =  J0  -  mL^ 
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Jo  is  the  moment  of  inertia  about  the  pivot  point  and  Jy  the  moment  of  inertia 

about  the  'y'  axis.  A  reasonable  value  of  'L'  was  selected  to  be  approximately 

one  vehicle  length,  or  about  30  inches.  This  results  in  a  reasonable  value  for 

the  period  and  ensures  sufficient  motion  for  gyro  sensing.  A  12  volt  DC 

power  source  supplied  power  to  the  gyro  motors  and  instrumentation.  The 

output  of  the  gyro  being  tested  was  connected  to  a  strip  chart  recorder, 

multimeter  and  oscilloscope.  The  vehicle  was  positioned  in  the  horizontal 

while  hanging  motionless.  A  level  was  used  to  ensure  it  was  completely 

horizontal.  The  gyro  bias  was  adjusted  to  bring  it  near  zero.  Motion  was  then 

initiated  by  pulling  the  vehicle  along  the  desired  axis  and  releasing. 

Sinusoidal  motion  was  recorded  on  the  strip  chart  as  the  gyro  sensed 

movement  about  its  reference  axis.  Thus,  by  measuring  the  period  of  the 

motion  from  the  strip  chart  recording,  the  moment  of  inertia  could  be 

calculated.  Several  runs  were  performed.  Figure  39  is  the  strip  chart 

recording  for  the  first  run.  During  this  run  the  length  from  the  pivot  point  to 

the  centerline  of  the  vehicle  was  set  at  31.1875  inches.  The  center  of  mass  is 

0.1  inches  below  the  centerline.  This  gives  a  total  length,  L,  of  31.2875 

inches.  The  period  measured  was  1.816  seconds.  The  mass  moment  of 
inertia,  Jy,  was  calculated  to  be  about  0.13  ft-lbf-sec^.  Another  test  was  run 

the  following  day.  The  length  of  the  pivot  was  slightly  different  since  the 
model  had  been  rerigged.  The  length  from  the  pivot  to  the  vehicle  centerline 
was  30.375  inches.  This  gives  a  pivot  length,  L,  of  30.475  inches.  The  period 
was  measured  as  1.80  seconds.  The  mass  moment  on  inertia  was  again 
calculated  and  found  to  be  0.16  ft-lbf-sec^.  The  slight  difference  may  be  due 
to  the  error  in  reading  the  number  of  cycles  on  the  strip  chart  and  the 
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measurement  of  the  pivot  arm  length.  The  first  test  was  run  with  cotton 
string  as  the  support  wires  and  the  second  test  used  monofilament  fishing 
line.  Both  of  these  values  of  inertia  agree  well  with  the  original  estimate.  As 
expected,  the  estimate  was  slightly  larger  since  it  assumed  uniform  mass 
distribution  while  the  experimental  value  is  based  on  the  actual  mass 
distribution. 

The  test  was  also  performed  to  measure  the  mass  moment  of  inertia  about 
the  'x'  axis.  A  period  of  =  1.77  seconds  was  measured  from  the  stripchart 

recording.  The  length  from  t,'  rot  point  to  mass  center  was  30.475  inches. 
The  value  of  Jx  measured  was  =  0.02  ft-lbf-sec^.  The  estimated  value  as 

calculated  in  Chapter  3  was  also  =  0.02  ft-lbf-sec^.  Less  error  between 
measured  and  estimated  values  exists,  as  compared  to  the  'y'  axis  values, 
because  the  assumption  of  uniform  mass  distribution  about  the  Y  axis  is  a 
closer  approximation  to  the  actual  vehicle. 

An  additional  test  conducted  was  to  integrate  a  gyro  output  and  display  it 
on  the  strip  chart  recorder.  This  test  was  to  verify  gyro  output  sensitivity  and 
the  quality  of  the  integrated  signal.  For  almost  imperceptiple  visual  motions 
the  gyro  produced  clear  sinusoidal  output  signals.  The  signal  was  also  fed  to 
an  analog  computer  for  integration.  The  vehicle  was  rotated  about  the  pitch 
axis  by  hand  allowing  the  suspension  wires  to  slip  through  the  pivot  point 
eyebolt.  The  elevation  of  the  forward  dive  planes  and  the  propellor  shaft 
penetrations  with  respect  to  the  deck  were  then  measured  using  a  scale  rule. 
Since  the  length  between  these  points  as  measured  along  the  vehicle  axis  was 
known,  the  angle  of  inclination  could  be  determined  using  simple  geometry. 
It  was  determined  that  integration  was  possible  and  could  provide  a  means  of 
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determining  vehicle  angular  position;  however,  the  problem  of  gyro  bias 
integration  would  have  to  be  solved.  The  gyro  bias  did  not  appear  to  remain 
at  an  initial  value  but  drifted  during  operation.  Gyro  bias  is  a  real  problem 
and  needs  to  be  compensated  for  in  precision  control. 

F.    PRELIMINARY  TESTING  FOR  STABILITY 

Simulation  studies  showed  the  vehicle  to  be  directionally  stable.  With  the 
vehicle  near  neutral  bouyancy  it  was  a  simple  matter  to  check  for  directional 
stability.  With  the  model  ready  for  testing,  the  large  test  tank  was  filled.  The 
model  was  launched  at  various  speeds  along  a  horizontal  path.  A  dive  plane 
angle  was  given  to  initiate  a  dive  maneuver.  After  the  model  developed  a 
pitch  angle  of  at  least  ten  degrees,  the  dive  planes  were  returned  to  their  zero 
position.  A  pitch  rate  opposite  to  that  which  had  been  initiated  by  the  control 
action  was  immediately  apparent  and  the  vehicle  began  to  return  to  a 
horizontal  position.  At  slow  speeds,  as  expected,  this  effect  was  more 
pronounced.  This  is  because  of  the  independence  of  the  restoring  moment 
from  speed  and  its  dominance  over  hydrodynamic  dependent  system 
coefficients  at  low  speeds.  At  higher  speeds  the  tendency  existed  but 
insufficient  room  in  the  tank  prevented  the  vehicle  from  returning  to  the 
horizontal  plane  prior  to  collision  with  tank  bottom. 

From  preliminary  testing,  when  familiarization  with  the  control  system 
was  in  progress,  it  was  evident  that  one  person  had  difficulty  providing 
adequate  control  over  both  the  dive  planes  and  rudder.  Frequent  collisions 
with  tank  sidewalls  took  place.  It  was  desired  to  keep  the  model  centered  with 
respect  to  tank  sidewalls.  To  allow  a  second  person  to  take  control  of  the 
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rudders,  a  separate  potentiometer  control  box  was  connected  to  the  radio 
control  unit  rudder  control  channel.  The  control  box  had  sufficient  cable 
length  to  permit  the  operator  to  remain  at  the  end  of  the  test  tank  in  constant 
view  of  the  model  with  respect  to  tank  longitudinal  centerline.  This  freed  the 
other  operator  to  concentrate  on  performing  vertical  plane  maneuvers. 

G.   DIVE  PLANE  AND  ROLL  PLANE  COMMAND  SIGNAL 
CALIBRATION 

In  order  to  know  the  dive  plane  angle  for  data  analysis,  a  calibration  had 

to  be  done  to  determine  the  amount  of  voltage  corresponding  to  each  angle 

order.  The  control  box  output  command  signals  for  dive  control,  roll  control 

(aileron),  speed  and  rudder  were  measured  and  found  to  vary  about  0.5  volts 

from  a  reference  voltage  of  roughly  2.5  volts.  In  order  to  record  these 

signals  on  the  stripchart  recorder  it  was  necessary  to  reduce  or  remove  the 

reference  voltage.  Insufficient  zero  adjust  was  available  on  the  strip  chart 

recorder  to  compensate  for  these  voltages  and  still  allow  monitoring  of  the 

entire  control  signal  range.  Because  of  the  low  analog  computer  input 

impedence,  a  one  megohm  resistor  was  inserted  at  the  operational  amplifyer 

(op-amp)  input.  The  signal  was  then  sent  to  a  summer  where  a  compensating 

voltage  was  added  to  the  command  signal.  The  compensating  voltage  was 

adjustable  by  using  a  potentiometer  (pot)  to  provide  the  signal.  This  pot  was 

adjusted  to  produce  a  0.0  volt  output  from  the  summer  with  control  planes  at 

zero  angle  of  attack.  Since  the  dive  command  signal  was  of  primary 

importance,  only  two  pots  were  used.  One  was  used  to  zero  the  speed  signal 

and  the  other  for  dive  plane  command.  The  output  of  this  second  pot  was  also 

used  for  the  remaining  control  signal  summers  for  roil  control  and  rudder 
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control.  The  outputs  could  then  be  monitored  on  the  stripchart,  although  the 
signal  values  for  roll  (aileron)  and  rudder  were  not  zero  at  zero  angle  order. 
Figures  40  through  43  show  the  signal  curves  for  dive  plane  command  and 
roll  command  with  and  without  compensation  voltage. 
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Figure  40     Uncompensated  Roll  Control  Signal 


y  =  0.061  +  0.004X    R  =  0.99 


1.2000e-1 


LOOOOe-1  - 


%      8.00006-2  H 

> 

■o 

c 
«j 
E 
E 
£      4.0000e-2  - 


2.00006-2  - 


1 .35536-20 


-20 


t ' 1 • r 

-10  0  10 

Plane  Angle(R)  (DEGREES) 


20 


Figure  41      Compensated  Roll  Control  Signal 
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Figure  42     Uncompensated  Dive  Plane  Control  Signal 
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Figure  43      Compensated  Dive  Plane  Control  Signal 
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H.   DATA  ACQUISITION 

Five  channels  of  data  were  transmitted  from  the  vehicle  by  wire.  Along 
with  the  positive  and  negative  power  lines,  these  wires  were  wrapped 
together  to  form  the  data  and  power  cable.  Spare  wires  and  the  radio  receiver 
antenna  line  were  also  included.  These  wires  were  connected  to  a  standard 
teminal  board.  Table  7  gives  the  pin  number  vs.  data  channel  hookup. 


TABLE  7. 

TERMINAL  BOARD  HOOKUP 

Pin  Number 

Channel 

1 

Positive  Power  Lead 

2 

Yawrate  Gyro 

3 

Rollrate  Gyro 

4 

Pitchrate  Gyro 

5 

Speed  Pressure  Cell 

6 

Depth  Pressure  Cell 

7 

Antenna 

8 

Spare 

9 

Spare 

10 

Spare 

11 

Signal  Ground(connected  to  analog 

computer  ground) 

12 

Negative  Power  Lead 

The  terminal  board  was  secured  to  a  carriage  assembly  located  above  the 
tank.  This  carriage  traveled  the  length  of  the  tank.  Sufficient  cable  was  then 
run  between  the  terminal  board  and  the  recording  instruments  and  power 
supply  to  permit  operation  of  the  vehicle  down  the  complete  length  of  the  test 
tank.  A  six  ampere  rated  DC  power  supply,  with  floating  ground,  was  used  to 


88 


supply  the  necessary  12.0  volts  to  the  vehicle.  Current  drawn  reached  levels 
of  nearly  four  amperes  at  full  speed  ahead  on  the  throttle  control  with  all 
other  systems  on  line.  The  primary  data  signals  of  interest  were  the  DP  cell 
monitoring  depth  and  the  pitch  rate  gyro.  These  signals  along  with  the  yaw 
rate  gyro  and  the  DP  cell  monitoring  speed  were  connected  to  an  eight 
channel  stripchart  recorder.  Four  channels  had  been  assigned  to  vehicle 
signal  return  lines.  Roll  rate  was  not  monitored.  The  restoring  moment  acted 
against  any  inclination  of  the  vehicle  to  roll.  Mechanical  adjustment  of  dive 
planes  was  performed  to  minimize  any  mismatch  in  dive  plane  action  which 
would  cause  such  a  roll.  Differences  in  friction  in  the  forward  dive  plane 
shafting,  as  well  as  small  variances  in  actual  shape  and  size  which  resulted 
during  manufacture,  were  countered  by  the  restoring  moment.  No  dive 
induced  roll  was  observed.  The  other  four  channels  of  the  stripchart 
recorder  were  connected  to  the  output  of  the  analog  computer.  The  analog 
computer  was  used  to  modify  the  command  signals  for  rudder,  speed,  roll 
and  dive  planes  produced  by  the  radio  control  box.  One  potentiometer  was 
set  to  provide  2.19  volts  for  cancellation  of  a  2.19  volt  bias  in  the  dive  plane 
command  signal.  This  same  voltage  was  applied  to  summers  in  conjunction 
with  the  roll  and  rudder  signals  to  reduce  the  output  voltages  to  levels  within 
the  range  of  the  stripchart  recorder.  Another  potentiometer  was  used  to  zero 
the  command  speed  signal.  The  command  signals  monitored  were  speed, 
rudder  and  dive  plane  angle.  Pitch  was  fed  into  the  remaining  stripchart 
channel.  The  pitch  rate  signal  from  the  vehicle  gyro  was  fed  into  the  analog 
computer  relay  comparator.  Two  relay  comparators  had  been  installed  in  the 
computer  but  one  of  them  was  not  operational.  A  second  analog  computer 
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also  became  inoperable.  With  only  one  relay  comparator  available,  a  plus- 
minus  deadband  about  zero  could  not  be  provided.  By  careful  adjustment  of 
the  pitch  rate  gyro  zero  pot  the  gyro  bias  could  be  maintained  on  the  positive 
side  of  zero  volts.  The  analog  computer  relay  comparator  was  then  set  to 
perform  switching  at  zero  volts.  A  downward  pitch  of  the  vehicle  produced  a 
negative  output  signal  from  the  pitch  rate  gyro.  When  a  dive  was  performed 
the  switch  was  set  up  to  connect  the  rate  signal  to  the  input  of  an  integrator. 
The  output  of  the  integrator  was  a  signal  proportional  to  pitch.  Gyro  bias 
te   Ld  to  drift  somewhat  in  a  range  of  about  25  millivolts.  This  would 
introduce  error  in  any  fmal  calibration  relation  between  the  actual  angle  and 
a  corresponding  voltage.  This  bias  was  the  reason  a  deadband  was  required. 
Since  it  was  not  constant,  it  could  not  easily  be  compensated  for. 

The  pitch  rate  signal,  Depth  DP  cell  signal,  dive  plane  command  signal 
and  the  Speed  DP  cell  signal  were  connected  to  an  Analog  to  Digital 
Converter  (ADC)  board  so  this  data  could  be  digitized.  The  data  was  then 
recorded  by  computer.  By  analysis  of  the  data,  a  transfer  function  between 
the  input,  dive  piane  command,  and  output,  depth,  could  be  found  by  use  of 
least  square  fit  identification  methods.  Integration  of  the  pitch  rate  data 
would  also  provide  a  means  of  determining  pitch  angle  and  allow  calibration 
of  the  pitch  signal  generated  by  the  analog  computer  integrator.  Figure  44 
shows  the  basic  signal  flow  paths. 
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V.  RESULTS 

A.   INTRODUCTION 

This  chapter  describes  the  technique  used  to  evaluate  the  transfer 
functions  for  system  identification  and  presents  the  results.  Only  motion  in 
the  vertical  plane  was  analyzed.  MATRIXX  is  the  computer  software 
program  utilized  to  accomplish  this.  An  estimate  of  the  system  transfer 
function  was  made  as  described  in  the  previous  chapters.  Thirty -four  data 
runs  were  performed.  Model  vehicle  maneuvers  were  controlled  through  the 
use  of  a  remotely  operated  radio  control  unit.  The  radio  receiver  was  located 
aboard  the  vehicle.  The  radio  control  unit  was  operated  manually,  therefore, 
all  tests  were  open-loop.  Future  implementation  of  the  computer  controller 
will  provide  closed-loop  control. 

Ten  data  runs  were  selected  for  computer  analysis.  Five  of  those  runs 
were  selected  for  presentation  in  graphical  form.  Refer  to  Figures  45 
through  56.  These  runs  were  selected  based  on  data  quality  and  run 
performance.  Important  considerations  were  whether  the  test  run  was 
performed  with  minimal  rudder  operation,  speed  loss  or  any  obvious  outside 
disturbing  influence  present. 

For  both  the  theoretical  and  computer  generated  transfer  functions  a 
Single-Input-Single-Output  (SISO)  system  was  assumed.  A  Recursive  Least 
Squares  technique  was  used  to  fit  the  data.  This  technique  has  some  inherent 
problems  since  it  can  not  account  for  unmodeled  disturbances  or  biases.  An 
extended  Kalman  Filter  technique  might  be  able  to  compensate  for  these 
disturbances  and  biases  in  future  work. 
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B.   PREDICTED  TRANSFER  FUNCTIONS 

A  first  approximation  was  the  simplified  plant  model  incorporating  only 
the  pitch  equation  of  motion  with  indirect  hydrodynamic  coefficients 
neglected.  The  system  equations  are: 

e         cfjKyS  z     cf2u 

5"jyS2  +  BS  +  Me'    e  ~    S2 

Jy  =     0.6 

B  =     0.72 
Ky=-0.14 

Me=  0.16 

U=      1.0 
Cf1=    1.25 

Cf2  =  4.306 
These  equations  were  multiplied  by  the  necessary  conversion  constants  Cf  i 
and  Cf2,  which  were  determined  from  the  calibration  tests,  to  give  them 

dimensions  of  volts/volts.  The  second  model  utilized  the  equations  of  motion 

with  all  hydrodynamic  derivatives  acting.  These  equations  were  significantly 

more  complicated  to  solve  but  transfer  functions  were  derived.  The 

coefficients  of  each  term  are  comprised  of  various  combinations  of  the 

hydrodynamic  derivatives.  The  model  equations  are: 

£  = Esl+_Fs 

5      As3  +  Bs2  +  Cs  +  D 

z        N^s3  +  N2s2  +  N3S  +  N4 

q  ~      s2[D!S2  +  D2s  +  D3]  (?  ) 

where  q  =  9  after  nondimensionalizing. 
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These  equations  were  also  multiplied  by  necessary  conversion  factors  to  give 
them  dimensions  of  volts/volts.  The  constants  in  Equations  7a  and  7b 
correspond  to  the  following  hydrodynamic  coefficients. 


al=  -M'w 

a2= 

-Z' 

**  w 

bl=  -M'q 

b2= 

m'  -  Z'W 

cl=  (Ty-NTq) 

c2= 

-(Z'q  +  m') 

dl=  -M'0 

k2= 

Z'8 

kl=  M's 

A=b2*cl 

Nl=k2*  A 

B=b2*bl+a2* 

\-t 

+  al 

*  c2 

N2=k2*B  +  E*[U*b2-c2] 

C=b2*dl+a2* 

bl 

-al 

*  c2 

N3=  {k2  *  C  +  F  *  [U  *  b2  -c2] 

D=  a2  *  dl 

+  U  *  a2  *  E) 

E=  kl  *  b2 

N4=U*a2*F  +  k2*D 

F=  kl  *  a2  -  k2  * 

al 

Dl=b2*E 

D2=  a2  *  E  +  b2  *  F 

D3=  a2  *  F 

These  equations  were  then  discretized  to  determine  the  'z'  domain  transfer 
functions  using  a  zero  order  hold.  The  order  of  the  model  is  provided  as  an 
input  to  the  program.  A  least-squares -fit  method  was  then  performed  by  the 
program  to  adjust  equation  coefficients  until  the  best  fit  between  input  and 
output  data  was  achieved.  By  using  this  approach  to  system  identification,  the 
system  model  equations  could  be  adjusted  to  better  simulate  the  actual  vehicle 
characteristics.  This  allows  better  controller  design. 

C.   COMPUTER  SOLUTION  APPROACH 

The  basic  method  of  solving  for  the  transfer  functions  is  as  follows: 
l)  Load  the  data  file  for  the  particular  run  of  interest. 
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2)  Detrend  data  as  necessary. 

3)  Enter  the  order  of  the  transfer  function  numerator  and 
denominator. 

4)  Perform  recursive-least-squares  (RLS)  fit  of  the  data. 

5)  With  the  computer  generated  transfer  function,  simulate  the 
model's  response  to  the  input  data. 

6)  Compare  actual  response  to  simulated  response. 

Detrending  of  data  was  not  always  performed.  Caution  had  to  be  used  in 
using  this  software  capability.  Detrending  effectively  removes  constant  bias 
signals;  however,  if  applied  to  data  files  such  as  depth  or  dive  plane  command 
signals,  the  computer-generated  fit  may  be  poor.  These  signals  necessarily 
contain  a  non-zero  mean  value.  Detrending  was  performed  on  the  gyro 
output  since  these  gyros  did  exhibit  a  relatively  constant  bias  for  the  duration 
of  each  run,  although  in  theory,  they  should  have  had  none. 

D.  RESPONSE  OF  PITCHRATE  TO  DIVE  PLANE  ANGLE 

Ten  data  runs  were  analyzed  to  determine  the  transfer  function  between 
dive  plane  command  signal  and  pitch  rate.  Excellent  correlation  for  both  a 
second  order  and  third  order  transfer  function  was  achieved  for  the  runs 
conducted  at  the  two  higher  speeds  of  1.8  and  2.1  ft/sec.  Correlation  for  the 
lower  speed  run  conducted  at  about  1.2  ft/sec  was  not  as  good.  Very  little 
difference  between  second  order  and  third  order  approximations  was  found. 
This  seems  to  indicate  the  predominance  of  the  inertia  and  damping 
coefficients  over  other  system  parameters.  Thus,  a  simple  second  order 
system  model  provides  adequate  simulated  responses  with  the  restriction  that 
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speed  is  sufficient  to  reduce  the  effects  of  the  restoring  moment  and  other 
system  disturbances.  At  low  speeds  the  drag  from  the  data  and  power  cord 
appears  to  cause  a  sufficient  disturbing  moment  to  affect  vehicle  movement. 
Also,  the  gyro  signal  is  not  quite  as  large  with  the  slower  motions  taking 
place  at  lower  speeds.  The  predicted  discretized  transfer  functions  are 
presented  in  Table  8.  The  different  numerators  in  the  fourth  order  model 
transfer  functions  for  depth  vs.  pitchrate  is  because  some  of  the  coefficients 
in  the  numerator  are  functions  of  speed,  U.  The  second  order  model  for 
pitchrate  vs.  dive  plane  angle  was  found  by  simple  estimations  of  damping, 
forces  on  dive  planes,  etc.,  assuming  a  vessel  speed  of  one  ft/sec.  The  higher 
order  model  was  found  using  the  nondimensionalized  equations  of  motion 
which  include  the  effects  of  angle  of  attack  and  the  stability  derivative,  Mw. 

TABLE  8.  PREDICTED  TF 
PITCHRATE  vs.  DIVE  PLANE  ANGLE 

Second  Order  Third  Order 

{U=  1.0  ft/sec} 

Q 0.0142z  -0.0142  Q     1.54U[-0.1191z2+Q.2313z  -0.1122] 

5  ~  [z2  -1.9411  +0.9418]  5  =    [z^  -2.8074z2  +2.6257z  -0.8181] 

C.E.  Roots  :  0.9849,  0.9562       C.E.  roots  :  0.8888,  0.9593  ±  j  0.0141 

DEPTH  vs.  PITCHRATE 

Second  Order 

Z     0.0053825U[z+1.0] 

9"       [z2-2z+l] 

Fourth  Order 
Z     23.44[-0.0001z3  +Q.0034Z2  -Q.QQ63z  +0.0029] 
1    "  "     t/SCC}  G  "  U[z4  -3.8298z3  +5.4927z2  -3.4962z  +0.8332] 

Z     23.44[  0.0007z3  +Q.QQ27z2  -0.0Q70z  +0.0036] 
IU-1.8  it/sec)  ,  -  U[z4  _3>8298z3  +5A921Z2  -3.4962z  +0.8332] 
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TABLE  8.  continued 
Z     23.44[  0.0010z3  +0.002<Z2  -0.0073z  +0.0039] 
{U-2.1  ft/sec]  ^  -  U[z4  _3>8298z3  +  5A92lz^  -3.4962z  +0.8332] 

C.E.  roots  :  0.8529,  1.0,  1.0,  0.9769 


E.   TRANSFER  FUNCTION  IDENTIFICATION 

Results  of  the  computer  fit  simulations  are  shown  in  Figures  45  through  56. 
The  abscissa  is  the  number  of  sampling  periods.  The  sampling  time  was  0.05 
seconds.  The  excellent  fit  between  actual  response  and  simulated  response 
indicates  that  this  is  a  rather  gooH  ^eans  of  determining  system  models.  That  is, 
building  a  test  model,  recording  rotational  rates,  depth,  speed  and  linear 
accelerations  to  develop  system  transfer  functions.  It  also  demonstrates  that  the 
predicted  theoretical  models  are  often  in  error.  It  is  difficult  to  accurately 
predict  submarine  motions  through  equations  developed  with  assumed  or 
roughly  estimated  hydrodynamic  coefficients.  The  predicted  transfer  functions 
which  relate  depth  to  pitchrate  differ  significantly  from  the  computer 
generated  transfer  functions.  Table  9  gives  a  summary  of  the  computer 
generated  transfer  functions.  With  some  calculations  or  by  an  iterative  process 
the  hydrodynamic  coefficients  which  are  in  error  might  be  determined. 

TABLE  9.  CALCULATED  TF 

Run  Number  Order  Transfer  Function 


9/2  2nd 


3rd 


6         0.033  Z  +  0.0758 
5"Z2  -  0.7812  Z  -  0.099 
C.E.  Roots  =  0.8922,  -0.1110 

g         0.0131  Z2  +  0.1236  Z  -  0.0222 
5~Z3  -  0.7751  Z2  -  0.0338  Z  -  0.0669 
C.E.  Roots  =  0.8961,  -0.0605  ±  j  0.2664 
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7/3  2nd 


3rd 


7/5  2nd 


3rd 


8/1  2nd 


3rd 


TABLE  9.    continued 

Q  0.0701  Z  -  0.053 

5~Z2  -  0.7397  Z  -  0.2053 
C.E.  Roots  =  0.9547,  0.2136 

9  0.079  Z2  -  0.0808  Z  +  0.0174 

5~Z3  -  0.76761  Z2  -  0.3062  Z  +  0.125 
C.E.  Roots  =  0.9513,  -0..4658,  0.2821 

Q         0.0196  Z  + 0.0132 


5     Z^  -  0.4239  Z  -  0.4417 
C.E.  Roots  --  Q.9095,  -0.4857 

Q         0.0198  Z2  +  0.0195  Z  -  0.0024 
S~Z3  -  0.3082  Z^  -  0.3171  Z  -  0.2285 
C.E.  Roots  =  0.9215,  -0.3066  ±j  0.3924 

Q         0.0602  Z  +  0.0875 
5~Z2  -  0.4565  Z  -  0.3950 
C.E.  Roots  =  0.8969,  -0.4404 

z  0.03  Z  -  0.056    

6~Z2  -  1.8729  Z  +  0.8727 
C.E.  Roots  =1.0017,  0.8712 

9        0.1367  Z2  -  Q.1Q51  Z  +  0.1579 
5~Z3  -  0.343  Z2  -  0.2446  Z  -  0.2211 
C.E.  Roots  =  0.8936,  -0.2753  ±  j  0.4142 


4th 

z  -0.076  Z3  +  0.122  Z?  -  0.0767  Z  -  0.0429 

9  ~Z4  -  0.8098  Z3  -  0.8152  Z2  +  0.0982  Z  +  0.5267 
C.E.  Roots  =  1.0018,  0.984,  -0.588  ±  j  0.4343 
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9/1  2nd 


3rd 


TABLE  9.    continued 

z         0.1151  Z  + 0.0832 
9~Z2  -  0.6302  Z  -  0.3103 
C.E.  Roots  =  0.9565,  -0.3245 

z         0.1266  Z- 0.1213 
9~Z2  -  1.697  Z  + 0.6957 
C.E.  Roots  =1.0041,  0.6928 

0_       0.0641  Z2  +  0.2092  Z  -  0.0629 
5~Z3  -  0.5989  Z2  -  0.2345  Z  -  0.1077 
C.E.  Roots  =  0.9600,  -0.1806  ±j  0.2821 


4th 

z      -0.0291  Z3  +  0.0252  Z?  +  0.0431  Z  -  0.0572 
e"z4  -  1.1377  Z^  -  0.291  Z2  +  0.06  Z  +  0.3683 
C.E.  Roots  =  1.0059,  0.9646,  -0.4164  ±  j  0.4541 

z 0.0811  Z-  0.0952 

5~Z4  -  1.1415  Z^  -  0.284  Z^  +  0.0577  Z  +  0.3699 
C.E.  Roots  =  0.9996,  0.9709,  -0.4145  ±  j  0.4552 

F.    DISCUSSION 

1.    Run  7/3 

The  forward  speed  was  1.2  ft/sec.  Figure  45  shows  the  pitchrate 
response  of  the  vehicle  to  the  detrended  dive  plane  command  input,  UD, 
shown  in  Figure  46.  The  actual  response  is  curve  1.  The  computer  generated 
fit  for  a  second  order  and  third  order  transfer  function  are  shown  as  curves  2 
and  3  respectively.  The  response  predicted  by  the  2nd  order  theoretical 
model  equation  is  also  shown.  This  run  was  performed  at  a  relatively  slow 
speed  of  1 .2  ft/sec.  It  is  apparent  that  outside  disturbances  were  taking  place 
which  were  not  accounted  for  in  the  models.  These  disturbances  are 
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attributed  to  the  power  and  data  cord,  noise,  and  a  drifting  bias  in  the  gyro 
sensors.  The  cord  caused  a  slight  negative  bouyancy  on  the  stern  section  of 
the  vehicle.  (Future  tests  might  consider  the  use  of  a  neutrally  bouyant  cord.) 
Gyro  bias  is  a  serious  problem  which  the  models  could  not  predict. 

2.  Run  7/5 

The  forward  speed  was  1.2  ft/sec.  Figure  47  shows  the  pitchrate 
response  to  the  square  wave  input,  Y4,  shown  in  Figure  48.  The  pulse  width 
of  the  input  command  signal  is  longer  than  in  the  previous  run.  A  better  fit  to 
the  actual  outr *£,  curve  1,  is  evident.  Curve  2  is  the  second  order  transfer 
function  and  curve  3  is  the  third  order  fit.  For  this  run  the  data  was  not 
detrended  but  rather  adjusted  to  begin  at  zero.  The  RLS  technique  requires 
zero  initial  conditions  for  best  data  correlation. 

3.  Run  8/1 

Speed  for  this  run  was  measured  to  be  2.1  ft/sec.  Figure  49  shows  the 
pitchrate  output,  curve  1 ,  and  computer  fit  curves  for  a  second  and  third 
order  transfer  function.  Curves  2  and  3  lie  directly  on  top  of  each  other 
indicating  that  the  second  order  transfer  function  accurately  predicts  the 
vehicle  output.  The  excellent  fit  for  this  data  run  is  believed  to  be  the  result  of 
operating  at  higher  speed  which  minimizes  the  effect  of  the  data  cord  and 
other  minor  disturbances.  The  depth  is  plotted  in  Figure  50.  Curve  1  is  the 
actual  output.  Curve  2  is  the  second  order  computer  model.  It  can  not 
accurately  predict  the  depth  response  since  it  lacks  the  two  required 
integrations  relating  pichrate  to  depth.  The  fourth  order  model,  curve  3, 
does  provide  a  reasonable  prediction  of  depth,  however,  the  initial  condition 
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for  rate  of  change  of  depth  is  not  zero  as  required  for  proper  data  correlation 
when  using  RLS.  Figure  51  shows  the  dive  plane  command  input,  Y4. 

4.  Run  9/1 

This  run  was  conducted  at  1.8  ft/sec.  A  reasonable  second  and  third 
order  fit  to  the  output,  curve  1 ,  was  achieved.  Curves  2  and  3  lie  very  close 
together  indicating  that  the  second  order  fit  can  accurately  predict  pitchrate 
output.  Depth  correlation  could  not  be  achieved  for  this  run.  Figure  53 
demonstrates  the  effect  of  varying  the  order  of  the  transfer  function.  Curve  2 
is  the  second  order  fit  between  depth  and  pitchrate  arid  curve  3  is  the  third 
order  fit.  Curve  4  is  the  transfer  function  relating  dive  plane  command  to 
depth.  This  seems  indicative  of  the  disturbing  influence  of  the  data  and  power 
cord  on  depth.  Other  difficulties  arise  from  the  fact  that  initial  conditions  are 
not  all  zero.  Figure  54  shows  the  input  dive  plane  command  signal,  Y4,  with 
bias  offset  removed. 

5.  Run  9/2 

This  run  was  performed  at  1.8  ft/sec  but,  the  dive  plane  command 
signal  was  rapid  sinusoidal  shaped  versus  the  short  pulse  width  input  of  Run 
9/1.  Figure  55  shows  the  actual  output,  curve  1,  and  the  second  and  third 
order  fits,  curves  2  and  3  respectively,  in  response  to  the  input  shown  in 
Figure  56.  An  excellent  fit  is  achieved  here  since  the  rapid  cycling  of  dive 
plane  command  signal  provided  a  rapid  and  relatively  large  gyro  output. 
This  masked  the  effects  of  bias  and  noise. 
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VI.  CONCLUSIONS  AND  RECOMMENDATIONS 

A.   CONCLUSIONS 

It  is  evident  that  excellent  results  can  be  achieved  by  Recursive  Least 
Square  Fit  of  vehicle  response  data  that  has  been  recorded  from  actual  model 
tests.  The  development  of  a  controller  can  proceed  with  a  high  probability  of 
excellent  results.  This  is  made  possible  by  the  availability  of  accurate  transfer 
function  dat° 

Changes  in  speed  definately  alter  the  vehicle  response  characteristics  as 
indicated  by  the  changing  values  of  the  coefficients  for  the  transfer  functions. 
Adaptive  type  controllers  would  most  likely  be  the  most  efficient  means  of 
maintaining  an  accurate  prediction  of  vehicle  response.  The  strong  influence 
of  speed  on  the  values  of  the  system  coefficients  is  evident.  In  an  actual 
vehicle,  speed  must  be  known  for  purposes  of  adjusting  controller  model 
equations  as  well  as  for  navigational  purposes  if  accurate  vehicle  control  is 
necessary.  Prediction  of  pkchrate  from  dive  plane  command  signals  was 
acceptable  when  considering  open  loop  conditions  were  used  for  test  vehicle 
control.  Prediction  of  depth  was  much  more  difficult  because  of  the  effects  of 
unmodeled  outside  disturbances  such  as  the  data  and  power  cord,  gyro  biases 
and  wall  effects  when  operating  near  the  tank  bottom  or  sidewalls.  Some  data 
runs  were  conducted  that  involved  large  changes  in  depth.  This  resulted  in 
operation  near  the  tank  bottom  and  utilized  the  full  range  of  the  installed 
depth  sensor.  Some  effect  on  data  output  may  have  taken  place  which  has  not 
been  accounted  for. 


114 


The  predominate  equation  coefficients  are  those  related  to  inertia  and 
damping.  They  have  the  most  significant  effect  on  pitchrate  as  denoted  by  the 
fit  between  actual  pitchrate  output  and  both  the  theoretical  and  computer 
predicted  output. 

The  higher  order  theoretical  model  equations  did  not  give  as  good  a 
prediction  of  depth  or  pitchrate  as  hoped,  indicating  the  strong  probability 
that  the  effective  hydrodynamic  coefficients  and  stability  derivatives  vary. 

B.   RECOMMENDATIONS 

Further  study  in  identifying  actual  model  hydrodynamic  coefficients 
might  provide  additional  information  concerning  the  importance  of  various 
coefficients  and  their  relationship  to  this  particular  vehicle  shape.  System 
identification  with  closed  loop  control  should  reduce  the  influence  of 
unmodelled  disturbances. 

Improvement  to  the  depth  sensing  system  by  redesigning  the  pressure 
lines  could  prevent  air  entrapment,  and  subsequent  errors  due  to  trapped 
water  columns. 

Removal  of  the  low  range  pressure  cell  associated  with  the  velocity 
measurement  system  would  allow  installation  of  a  sensor  for  measuring  pitch 
angle  directly.  This  could  be  achieved  by  utilizing  a  higher  range  differential 
pressure  cell.  The  high  pressure  port  would  be  connected  to  the  stagnation 
tube  and  the  low  pressure  port  would  be  connected  to  the  sensing  line 
associated  with  the  depth  sensor.  With  proper  design,  water  may  be 
prevented  from  entering  the  sensing  lines.  The  columns  of  air  are  negligible 
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to  that  of  the  water  columns  so  the  cell  can  be  calibrated  to  read  the  angle  of 
inclination.  Additionally,  the  following  items  are  suggested: 

Redesign  of  the  forward  dive  plane  mechanical  linkage  assembly  is 
needed.  At  present,  excessive  friction  exists  in  the  aileron  control  link  collar. 

Installation  of  an  additional  midsection  to  the  vehicle  to  accomodate  a 
battery  system  for  vehicle  power  will  reduce  the  size  of  the  tether,  however, 
the  vehicle  may  then  be  too  large  for  the  present  test  tank  necessitating  a 
larger  tank. 

The  possibility  of  installing  a  radiotelemetry  device  for  data  transmission 
should  be  investigated.  This  will  remove  the  requirement  of  a  tether 
altogether. 

Establishment  of  zero  initial  conditions  for  all  test  runs  and  the 
minimization  of  operation  in  vicinity  of  tank  boundaries  will  improve 
usefulness  of  data. 
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APPENDIX  A 


FILE:  T2 


FORTRAN   A 


SUBMARINE  MOTION  SIMULATION 

Kl  =  CONTROL  DERIV  FOR  HEAVE 

K2  =  CONTROL  DERIV  FOR  PITCH 

Al  =  LINEAR  INERTIA  HYD  DERIV 

Bl  =  LINEAR  DAMPING  HYD  DERIV 

CI  =  COUPLED  ROTARY  ACCEL  HYD  DERIV 

A2  =  MOMENT  OF  INERTIA  HYD  DERIV 

32  =  ROTARY  DAMPING  HYD  DERIV 

C2  =  HYDROSTATIC  RESTORING  MOMENT  HYD  DERIV 

D2  =  COUPLED  LINEAR  ACCEL  HYD  DERIV 

U=1.0,  XG=0.0,  BG=0.1,  L=2S.O 

INITIAL  CONDITIONS 

W0=0.0,  Q0=0.0,  T0=0.0,  X0=0.0,  ZO=0.0 

HYDRODYNAMIC  DERIVATIVES 

Kl=0.095,  K2=-0.1S4 

Al=1.046,  Bl=1.295,  Cl=-0.196 

A2=0.072,  B2=0.20,  C2=1.27,  D2=-0 . 033 

WDOT=(Kl*DEL-ClxQ-Bl*W)/Al 

W=INTGRL(WO,WDOT) 

QD0T=(K2*DEL-D2*W-C2*THETA-B2*Q)/A2 

Q=INTGRL(QO,QDOT) 

THETA=INTGRL(TO,Q) 

*  DEL=DIVE  PLANE  ANGLE 
DEL=0.52359S7*STEP(0.0)  -  0 . 5235937*STEP( 10 . 0) 

*  TRAJECTORY  CALCULATION 
ZG=3G/L 
UG=U+ZG*(Q) 
WG=W+XG*(Q) 

alpha=6 . 2s31s53-theta 

xdot=ug*cos(alpha)  -  wg*sin(alpha) 

zdot=ug*sin(alpha;  +  wg*cos(alphaj 

x=intgrlcxo,xdot) 

z=intgrlcz0,zdot) 
contrl  fintim=30,  delt=0.001 
print  1.0,  w,theta,x,z 
save  (si)  0.005,  w,wdot,del 
save  (s2)  0.005,  q,qdot,del 
save  css)  0.01,  x,z,theta 
craph(g1/s1,de=tek613,po=0, .5)  time, w, wdot, del 
graph(g2/s2,de  =  te:<613,po  =  0,  .5)  time,  q,  qdot,  del 
graph(g3/s3,de=tek613,po=0, .5)  x,z,theta 
label(g1,de=tek613)  linear  velocities  and  accelerations 
label(g2,de=tek613)  angular  velocities  and  accelerations 
label(g3,de=tek61s)  vertical  plane  maneuver 
label(all,de=tek613)  forward  velocity  =  1.0  ft/sec 

END 
STOP 


TITLE 

* 

* 

* 

* 

* 

* 

PARAM 

CONST 

* 

CONST 

CONST 

CONST 
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FILE: 

T3 

TITLE 

SU 

* 

Kl 

* 

K2 

* 

Al 

x 

Bl 

* 

CI 

* 

A2 

* 

B2 

3 

C2 

X 

D2 

FORTRAN   A 


TITLE  SUBMARINE  MOTION  SIMULATION 

CONTROL  DERIV  FOR  HEAVE 

CONTROL  DERIV  FOR  PITCH 

LINEAR  INERTIA  HYD  DERIV 

LINEAR  DAMPING  HYD  DERIV 

COUPLED  ROTARY  ACCEL  HYD  DERIV 

MOMENT  OF  INERTIA  HYD  DERIV 

ROTARY  DAMPING  HYD  DERIV 

HYDROSTATIC  RESTORING  MOMENT  HYD  DERIV 

COUPLED  LINEAR  ACCEL  HYD  DERIV 
PARAM  U=1.0,  XG=0.0,  BG=0.1,  L=23.0 

*  INITIAL  CONDITIONS 

CONST  N0=0.0,  QO=0.0,  TO=0.0,  X0=0.0,  Z0=0.0 

*  HYDRODYNAMIC  DERIVATIVES 
CONST  Kl=0.095,  K2=-0.134 
CONST  A1=0.,  B1=0.,  C1=0.,  W=0. 

CONST  A2=0.072,  B2=0.20,  C2=1.27,  D2=0. 

*  WD0T=(K1*DEL-C1*Q-B1*W)/A1 
X      W=INTGRL(W0,WDOT) 

QDOT=(K2xOEL-D2*W-C2xTHETA-B2XQ)/A2 

Q=INTGRL(Q0,QDOT) 

THETA=INTGRL(TO,Q) 
X      DEL=DIVE  PLANE  ANGLE 

DEL=0.5235937XSTEP<0.0)  -  0 .5235987*STEP<10 . 0) 
X      TRAJECTORY  CALCULATION 

ZG=BG/L 

UG=U+ZGX(Q) 

WG=W+XG*(Q) 

ALPHA=6 .2S31353-THETA 

XDOT=UGXCOS(ALPHA)  -  WGXSIN(ALPHA) 

ZDOT=UG*SIN(ALPHA)  +  WGXCOS( ALPHA) 

X=INTGRL(X0,XDOT) 

Z=INTGRL(Z0,ZDOT) 
CONTRL  FINTIM=30,  DELT=0.001 
PRINT  1.0,  THETA,X,Z 
XSAVE  (SI)  0.005,  W,WDOT,DEL 
SAVE  (S2)  0.005,  Q,QDOT,DEL 
SAVE  (S3)  0.01,  X,Z,THETA 

XGRAPH(G1/S1,DE=TEK613,P0=0, .5)  TIME, W, WDOT, DEL 
GRAPH(G2/S2,DE=TEK61S,P0=O, .5)  TIME, Q, QDOT, DEL 
GRAPH(G3/S3,DE=TEK613,PO=0> .5)  X,Z,THETA 

*LABEL(G1,DE=TEK613)  LINEAR  VELOCITIES  AND  ACCELERATIONS 
LABEL(G2,DE=TEK613)  ANGULAR  VELOCITIES  AND  ACCELERATIONS 
LABEL(G3,DE=TEK613)  VERTICAL  PLANE  MANEUVER 
LABEL(ALL,DE=TEK613)  FORWARD  VELOCITY  -    1.0  FT/SEC 
END 
STOP 
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* 

Kl 

* 

K2 

* 

Al 

* 

Bl 

* 

CI 

*. 

A2 

X 

B2 

s 

C2 

3 

D2 

FILE:  T4       FORTRAN   A 


TITLE  SUBMARINE  MOTION  SIMULATION 

CONTROL  DERIV  FOR  HEAVE 

CONTROL  DERIV  FOR  PITCH 

LINEAR  INERTIA  HYD  DERIV 

LINEAR  DAMPING  HYD  DERIV 

COUPLED  ROTARY  ACCEL  HYD  DERIV 

MOMENT  OF  INERTIA  HYD  DERIV 

ROTARY  DAMPING  HYD  DERIV 

HYDROSTATIC  RESTORING  MOMENT  HYD  DERIV 

COUPLED  LINEAR  ACCEL  HYD  DERIV 
PARAM  U=1.0,  XG=0.0,  BG=0.1,  L=23.Q 

*  INITIAL  CONDITIONS 

CONST  WO=0.0,  Q0=0.0,  TQ=0.0,  XO=0.0,  ZO=Q . 0 

*  HYDRODYNAMIC  DERIVATIVES 
CONST  Kl=0.095,  K2  =  -0.18<+ 
CONST  A1=0.,  B1=0.,  C1=0.,  W  =  0. 

CONST  A2=0.072,  32=0.20,  C2=0.00,  D2=0. 

*  WD0T=(K1*DEL-C1*Q-31*W)/A1 

*  W=INTGRL(WO,WDOT) 

QD0T  =  (K2*DEL-D2*W-C2*THETA-B2*QVA2 

Q=INTGRL(Q0,QDOT) 

THETA=INTGRLCTO,Q) 

*  DEL=DIVE  PLANE  ANGLE 
DEL=0.5235987*STEP(0.0)  -  0 .5235937*STEP<1 . 0 ) 

X     TRAJECTORY  CALCULATION 

ZG=BG/L 

UG  =  t:+ZG*(Q) 

WG=W+XG*(Q) 

ALPHA=6.2331353-THETA 

XDOT=UG*COS(ALPHA)  -  WG*SIN( ALPHA ) 

ZDOT=UG*SINCALPHA)  +  WG*COSCALPHA; 

X=INTGRLCX0,XDOT) 

Z=INTGRLCZ0,ZDOT) 
CONTRL  f;:ntim=i5,  DELT  =  0.001 
PRINT  1.3,  THETA,X,Z 
*SAVE  CS13  0.005,  W,WDOT,DEL 
SAVE  (S2)  0.005,  Q,QDOT,DEL 
SAVE  (.SZ)    0.01,  X,Z,THETA 

*GRAPH(G1/S1,DE=TEK613,P0=0,  .5)  TIME, W, WDOT, DEL 
uR«Prl(G2/S2,DE  =  TEK613,P0  =  0,  .5)  TIME,Q,QDOT 
GRAPH(G3/S3,DE=TEK613,PO=0, .5)  X,Z,THETA 

*LABEL(G1,DE  =  TEK613]>  LINEAR  VELOCITIES  AND  ACCELERATIONS 
LABEL(G2,DE=TEK618)  ANGULAR  VELOCITIES  AND  ACCELERATIONS 
LABEL(G3,DE=TEK613)  VERTICAL  PLANE  MANEUVER 
LABEL(ALL,DE=TEK613)  FORWARD  VELOCITY  =1.0  FT/SEC 
END 
STOP 
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X 

Kl 

* 

K2 

* 

Al 

* 

Bl 

* 

CI 

X 

A2 

X 

B2 

X 

C2 

X 

D2 

FILE:  T5       FORTRAN   A 


TITLE  SUBMARINE  MOTION  SIMULATION 
CONTROL  DERIV  FOR  HEAVE 
CONTROL  DERIV  FOR  PITCH 
LINEAR  INERTIA  HYD  DERIV 
LINEAR  DAMPING  HYD  DERIV 
COUPLED  ROTARY  ACCEL  HYD  DERIV 
MOMENT  OF  INERTIA  HYD  DERIV 
ROTARY  DAMPING  HYD  DERIV 
HYDROSTATIC  RESTORING  MOMENT  HYD  DERIV 
COUPLED  LINEAR  ACCEL  HYD  DERIV 
PARAM  U=1.0,  XG=0.0,  BG=0.1,  L=2S.Q 
x      INITIAL  CONDITIONS 

CONST  WO=0.0,  Q0=0.0,  T0=0.0,  XO=0.0,  ZO=0.0 
x      HYDRODYNAMIC  DERIVATIVES 
CONST  Kl=0.095,  K2=-0.134 
CONST  Al=1.046,  Bl=1.295,  Cl=-0.196 
CONST  A2=0.072,  B2=0.02,  C2=1.27,  D2=-0.033 

WD0T  =  (K1*DEL-C1*Q-31*WVA1 

W=INTGRLCWO,WDOT) 

QD0T=(K2XDEL-D2XW-C2XTHETA-B2XQ)/A2 

Q=INTGRL(QO,QDOT) 

THETA=INTGRL(TO,Q) 
*     DEL=DIVE  PLANE  ANGLE 

DEL=0.5235987XSTEP(0.0)  -  0 . 5235987*STEP( 10 . 0) 
X     TRAJECTORY  CALCULATION 

ZG=BG/L 

UG=U+ZG*(Q) 

WG=W+XGX(Q) 

ALPHA=6.2831353-THETA 

XDOT=UGXCOS(ALPHA)  -  WGXSINCALPHA) 

ZDOT=UGXSIN(ALPHA)  +  WG^COS(ALPHA) 

X=INTGRL(X0,XDOT) 

Z=INTGRL(Z0,ZDOT) 
CONTRL  FINTIM=30,  DELT=0.001 
PRINT  1.0,  W,THETA,X,Z 
SAVE  CS1)  0.005,  W,WDOT,DEL 
SAVE  (S2)  0.005,  Q,QDOT,DEL 
SAVE  (S3)  0.01,  X,Z,THETA 

GRAPH(G1/S1,DE=TEK618,P0=0, .5)  TIME, W, WDOT, DEL 
GRAPH(G2/S2,DE=TEK61S,PO=0, .5)  TIME, Q, QDOT, DEL 
GRAPH(G3/S3,DE=TEK613,PO=0, .5)  X,Z,THETA 
LABEL(G1,DE=TEK613)  LINEAR  VELOCITIES  AND  ACCELERATIONS 
LABELCG2,DE=TEK613)  ANGULAR  VELOCITIES  AND  ACCELERATIONS 
LABEL(G3,DE=TEK613)  VERTICAL  PLANE  MANEUVER 
LABELCALL,DE=TEK618)  FORWARD  VELOCITY  =1.0  FT/SEC 
END 
STOP 
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APPENDIX  C 


FILE:  T6 


FORTRAN  A 


TITLE 

* 
* 
* 

x 

* 

CONST 
CONST 

INCON 


SUBMARINE  CONTROLLER  SIMULATION 

J  =  ROTARY  MOMENT  OF  INERTIA  WITH  ADDED  MASS 

B  =  EFFECTIVE  ROTARY  DAMPING  (BY  +  KR*KY) 

KPY  =  PROPORTIONAL  GAIN  (DIVE  ANGLE/PITCH  ANGLE  ERROR; 

KY  =  DIVE  PLANES  CONTROL  DERIVATIVE  (PITCH; 

KDZ  =  DERIVATIVE  GAIN 

KPZ    =  PROPORTIONAL  GAIN  (PITCH  ANGLE  ERRROR/DEPTH  ERROR: 

3Y  =  ROTARY  DAMPING 

U  =  FORWARD  VELOCITY 

J=0.6,  3Y=0.06,  KY=0.14,  U=1.0 

KPY=0.70,  KR=2.0 


Z0=0.0,  DEZ0=O.0 


KPZ=0.25,  KDZ=0.6Q 
INITIAL  CONDITIONS 
TDOT0=0.0,  T0=0.0, 
ZC=5.0*STEP(0.0; 
3= BY  +  KRXKY 
EZ=ZC-Z 

DEZ=DERIV(DEZ3.EZ; 
TC=KPZ*EZ  +  KDZXDEZ 
ET=TC-T 

del=kpy*et 

tddot=(kyxdel-bxtdot)/j 

tdot=intgrl (tdoto, tddot; 

t=intgrl(tq,tdot; 

zdot=uxsin(t; 

z=intgrl(Zo,zdot; 
contrl  fintim=50,  delt=0 
print  2.5,  del,zc,z,tc,t 

SAVE  (Si;  0.005,  DEL, ZC.Z 

save  (sz;  0.005,  zctct 
graph(g1/s1,de  =  tek61s,p0  =  0,  .5)  time, zcz,  del 
graph(g2/s2,de=tek61s,po=0, .5)  time, zc,t,tc 
label(gi,de=te:<613;     depth  variation 
la3el(g2,de=tex61s;    pitch  angle  variation 
label (all, de=tekols;    depth  controller,  u=1.0 

END 
STOP 
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